mirror of
https://github.com/meekrosoft/fff
synced 2026-01-23 00:15:59 +01:00
33 lines
557 B
C
33 lines
557 B
C
|
|
#include <string.h>
|
|
|
|
#include "sensor.h"
|
|
#include "bus.h"
|
|
|
|
#define SENSOR_ADDRESS 0xAA
|
|
#define SENSOR_REG_READ 0xF0
|
|
float LOCAL_buffer[4];
|
|
|
|
bool sensor_init()
|
|
{
|
|
memset( LOCAL_buffer, 0x00, sizeof(LOCAL_buffer));
|
|
return true;
|
|
}
|
|
|
|
float sensor_read()
|
|
{
|
|
char data[4] = { 0xFF, 0xFF, 0x00, 0x00 };
|
|
bus_read_write( SENSOR_ADDRESS, SENSOR_REG_READ, (uint8_t*)&data, 4, false );
|
|
|
|
if (data[0] != 0x10)
|
|
{
|
|
runtime_error("sensor read failed");
|
|
}
|
|
|
|
float ret_value = data[1] + data[2] / 256.0;
|
|
return ret_value;
|
|
}
|
|
|
|
|
|
|