Nuvoton Cortex-M0 und Sensor SRF02

[meemqri]

Hoffe hier kann mir jemand helfen. Ich nutze o.g. MC und Sensor und möchte diesen, wie könnte es anders sein, auslesen. Ich schaff es aber nur das LSB auszulesen, das MSB geht "verloren" oder so.
Hier mein Code zum Auslesen der Register von MSB und LSB:

	DrvI2C_Ctrl(I2C_PORT1, 1, 0, 1, 0);						//Start I2C
	while (DrvI2C_GetStatus(I2C_PORT1) != 0x08);
	
	DrvI2C_WriteData(I2C_PORT1, 0xE0);						//Slave Address
	DrvI2C_Ctrl(I2C_PORT1, 0, 0, 1, 0);
	while (DrvI2C_GetStatus(I2C_PORT1) != 0x18);
	
	DrvI2C_WriteData(I2C_PORT1, 3);								//Register 3
	DrvI2C_Ctrl(I2C_PORT1, 0, 0, 1, 0);
	while (DrvI2C_GetStatus(I2C_PORT1) != 0x28);
	
	DrvI2C_WriteData(I2C_PORT1, 2);								//Register 2
	DrvI2C_Ctrl(I2C_PORT1, 0, 0, 1, 0);
	while (DrvI2C_GetStatus(I2C_PORT1) != 0x28);
	
// 	DrvI2C_Ctrl(I2C_PORT1, 0, 1, 1, 0);						//Stop I2C
// 	while (DrvI2C_GetStatus(I2C_PORT1) != 0xF8);
	

	DrvI2C_Ctrl(I2C_PORT1, 1, 0, 1, 0);						//Restart I2C
	while (DrvI2C_GetStatus(I2C_PORT1) != 0x10);
	
	DrvI2C_WriteData(I2C_PORT1, 0xE1);						//Slave Address + 1 = Read Command
	DrvI2C_Ctrl(I2C_PORT1, 0, 0, 1, 0);
	while (DrvI2C_GetStatus(I2C_PORT1) != 0x40);
	
	uiMSB = (DrvI2C_ReadData(I2C_PORT1));						//Read MSB
	DrvI2C_Ctrl(I2C_PORT1, 0, 0, 1, 1);						//Clear Int Flag and ACK
	while (DrvI2C_GetStatus(I2C_PORT1) != 0x50);
	
	uiLSB = DrvI2C_ReadData(I2C_PORT1);						//Read LSB
	DrvI2C_Ctrl(I2C_PORT1, 0, 0, 1, 0);						//Clear Int Flag and NACK
	while (DrvI2C_GetStatus(I2C_PORT1) != 0x58);

	DrvI2C_Ctrl(I2C_PORT1, 0, 1, 1, 0);						//Stop I2C and Clear Int Flag

Ich kann nur Entfernungen bis exakt 255, also 0xFF messen, danach springt er auf 0 zurück

[meemqri]

Problem gelöst, nun funktioniert es.