test laser code
This commit is contained in:
@ -15,26 +15,26 @@
|
||||
unsigned char Laser_ReadReg(unsigned char reg)
|
||||
{
|
||||
unsigned char val;
|
||||
I2C1_Write(ADDR_LASER, reg);
|
||||
I2C1_Read(ADDR_LASER, &val, 1);
|
||||
I2C1_Stop();
|
||||
I2C2_Write(ADDR_LASER, reg);
|
||||
I2C2_Read(ADDR_LASER, &val, 1);
|
||||
I2C2_Stop();
|
||||
return val;
|
||||
}
|
||||
|
||||
unsigned char Laser_WriteReg(unsigned char reg, unsigned char reg2)
|
||||
{
|
||||
unsigned char val;
|
||||
I2C1_Write(ADDR_LASER, reg);
|
||||
I2C2_Write(ADDR_LASER, reg);
|
||||
|
||||
I2C1_Write(ADDR_LASER, reg2);
|
||||
I2C1_Stop();
|
||||
I2C2_Write(ADDR_LASER, reg2);
|
||||
I2C2_Stop();
|
||||
return val;
|
||||
}
|
||||
|
||||
VL53L0X sensor;
|
||||
|
||||
bool Laser_Init_v2(void){
|
||||
I2C1_Init();
|
||||
I2C2_Init();
|
||||
bool fl = sensor.init();
|
||||
sensor.startContinuous();
|
||||
return fl;
|
||||
|
Reference in New Issue
Block a user