X-Git-Url: http://git.linex4red.de/pub/USBasp.git/blobdiff_plain/53ebb2f21a216281707f5d680181c3c4adc12772..1331cce08a6e899b15382dd1c6110565ed1b34c5:/Demos/Host/Incomplete/BluetoothHost/Lib/ServiceDiscoveryProtocol.c

diff --git a/Demos/Host/Incomplete/BluetoothHost/Lib/ServiceDiscoveryProtocol.c b/Demos/Host/Incomplete/BluetoothHost/Lib/ServiceDiscoveryProtocol.c
index f7935cad0..bd649419a 100644
--- a/Demos/Host/Incomplete/BluetoothHost/Lib/ServiceDiscoveryProtocol.c
+++ b/Demos/Host/Incomplete/BluetoothHost/Lib/ServiceDiscoveryProtocol.c
@@ -183,8 +183,6 @@ static uint32_t ServiceDiscovery_GetDataElementSize(const void** DataElementHead
 	uint8_t SizeIndex = (*((uint8_t*)*DataElementHeader) & 0x07);
 	*DataElementHeader += sizeof(uint8_t);
 	
-	*ElementHeaderSize = 1;
-	
 	uint32_t ElementValue;
 	
 	switch (SizeIndex)
@@ -205,7 +203,8 @@ static uint32_t ServiceDiscovery_GetDataElementSize(const void** DataElementHead
 			*ElementHeaderSize  = (1 + sizeof(uint32_t));
 			break;
 		default:
-			ElementValue = (1UL << SizeIndex);
+			ElementValue = (1 << SizeIndex);
+			*ElementHeaderSize = 1;
 			break;
 	}