Exemplo n.º 1
0
bool HMC5883L::readRawAxis()
{
	SELECT_DEVICE(*fd, HMC5883L_ADDRESS, deviceName);
    
//	readBlockData(*fd, HMC5883L_DATA_REGISTER_BEGIN, 6, u8Buffer);

	readReg8( *fd, 0x03, &iBuffer[ 0 ]);
	readReg8( *fd, 0x04, &iBuffer[ 1 ]);
	readReg8( *fd, 0x05, &iBuffer[ 2 ]);
	readReg8( *fd, 0x06, &iBuffer[ 3 ]);
	readReg8( *fd, 0x07, &iBuffer[ 4 ]);
	readReg8( *fd, 0x08, &iBuffer[ 5 ]);
   
  	raw.XAxis = (int)(int16_t) ((iBuffer[0] << 8) | iBuffer[1]);
  	raw.ZAxis = (int)(int16_t) ((iBuffer[2] << 8) | iBuffer[3]);
  	raw.YAxis = (int)(int16_t) ((iBuffer[4] << 8) | iBuffer[5]);
    
  	return true;
}
Exemplo n.º 2
0
uint8_t ILI9341_kbv::readcommand8(uint8_t reg, uint8_t idx)         //this is the same as Adafruit_ILI9341
{
    readReg8(0xD9, 0x10 | idx);
    return readReg8(reg, 0xFF); 
}