deps/fff/examples/weak_linking/src/sensor.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29

#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;
}