mirror of
https://github.com/iNavFlight/inav.git
synced 2025-07-25 09:16:01 +03:00
38ec0b6080
clear what all gpio/ledring drivers need to compile and what was unnecessarily included before. In attempting this it was clear that ledring had a dependency on the multiwii code, this was removed by passing the led status update method the values it needs. It also turned out that the ROLL/PITCH defines were coming from rc_alias_e and much unrelated code is coupled to these defines. This commit also includes some cleanups relating to that problem.
64 lines
1.4 KiB
C
64 lines
1.4 KiB
C
|
|
#include <stdbool.h>
|
|
#include <stdint.h>
|
|
|
|
#include "platform.h"
|
|
|
|
#include "bus_i2c.h"
|
|
#include "sensors_common.h"
|
|
#include "axis.h"
|
|
#include "flight_common.h"
|
|
|
|
#include "maths.h"
|
|
|
|
// Driver for DFRobot I2C Led Ring
|
|
#define LED_RING_ADDRESS 0x6D
|
|
|
|
bool ledringDetect(void)
|
|
{
|
|
bool ack = false;
|
|
uint8_t sig = 'e';
|
|
|
|
ack = i2cWrite(LED_RING_ADDRESS, 0xFF, sig);
|
|
if (!ack)
|
|
return false;
|
|
return true;
|
|
}
|
|
|
|
// pitch/roll are absolute angle inclination in multiple of 0.1 degree 180 deg = 1800
|
|
void ledringState(bool armed, int16_t pitch, int16_t roll)
|
|
{
|
|
uint8_t b[10];
|
|
static uint8_t state;
|
|
|
|
if (state == 0) {
|
|
b[0] = 'z';
|
|
b[1] = (180 - heading) / 2; // 1 unit = 2 degrees;
|
|
i2cWriteBuffer(LED_RING_ADDRESS, 0xFF, 2, b);
|
|
state = 1;
|
|
} else if (state == 1) {
|
|
b[0] = 'y';
|
|
b[1] = constrain(roll / 10 + 90, 0, 180);
|
|
b[2] = constrain(pitch / 10 + 90, 0, 180);
|
|
i2cWriteBuffer(LED_RING_ADDRESS, 0xFF, 3, b);
|
|
state = 2;
|
|
} else if (state == 2) {
|
|
b[0] = 'd'; // all unicolor GREEN
|
|
b[1] = 1;
|
|
if (armed)
|
|
b[2] = 1;
|
|
else
|
|
b[2] = 0;
|
|
i2cWriteBuffer(LED_RING_ADDRESS, 0xFF, 3, b);
|
|
state = 0;
|
|
}
|
|
}
|
|
|
|
void ledringBlink(void)
|
|
{
|
|
uint8_t b[3];
|
|
b[0] = 'k';
|
|
b[1] = 10;
|
|
b[2] = 10;
|
|
i2cWriteBuffer(LED_RING_ADDRESS, 0xFF, 3, b);
|
|
}
|