Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-28 02:33:58 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_Periph: Add alternate ordering of NCP5623 LED colors

Browse Source
This commit is contained in:
Phillip Kocmoud 2020-12-11 21:19:28 -06:00 committed by Andrew Tridgell
parent 7449b3eea4
commit ce87b62dcc
4 changed files with 22 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
Tools/AP_Periph/AP_Periph.h
View File

@ -13,7 +13,7 @@
#include "../AP_Bootloader/app_comms.h" #include "../AP_Bootloader/app_comms.h"
#include "hwing_esc.h" #include "hwing_esc.h"
#if defined(HAL_PERIPH_NEOPIXEL_COUNT) || defined(HAL_PERIPH_ENABLE_NCP5623_LED) #if defined(HAL_PERIPH_NEOPIXEL_COUNT) || defined(HAL_PERIPH_ENABLE_NCP5623_LED) || defined(HAL_PERIPH_ENABLE_NCP5623_BGR_LED)
#define AP_PERIPH_HAVE_LED #define AP_PERIPH_HAVE_LED
#endif #endif

19
Tools/AP_Periph/can.cpp
View File

@ -550,6 +550,25 @@ static void set_rgb_led(uint8_t red, uint8_t green, uint8_t blue)
dev->transfer(&v, 1, nullptr, 0); dev->transfer(&v, 1, nullptr, 0);
} }
#endif // HAL_PERIPH_ENABLE_NCP5623_LED #endif // HAL_PERIPH_ENABLE_NCP5623_LED
#ifdef HAL_PERIPH_ENABLE_NCP5623_BGR_LED
{
const uint8_t i2c_address = 0x38;
static AP_HAL::OwnPtr<AP_HAL::I2CDevice> dev;
if (!dev) {
dev = std::move(hal.i2c_mgr->get_device(0, i2c_address));
}
WITH_SEMAPHORE(dev->get_semaphore());
dev->set_retries(0);
uint8_t v = 0x3f; // enable LED
dev->transfer(&v, 1, nullptr, 0);
v = 0x40 | blue >> 3; // blue
dev->transfer(&v, 1, nullptr, 0);
v = 0x60 | green >> 3; // green
dev->transfer(&v, 1, nullptr, 0);
v = 0x80 | red >> 3; // red
dev->transfer(&v, 1, nullptr, 0);
}
#endif // HAL_PERIPH_ENABLE_NCP5623_BGR_LED
} }
/* /*

2
libraries/AP_HAL_ChibiOS/hwdef/f303-M10025/hwdef.dat
View File

@ -15,7 +15,7 @@ BARO DPS280 I2C:0:0x77
# GPS+MAG+LED+Baro # GPS+MAG+LED+Baro
define HAL_PERIPH_ENABLE_GPS define HAL_PERIPH_ENABLE_GPS
define HAL_PERIPH_ENABLE_MAG define HAL_PERIPH_ENABLE_MAG
define HAL_PERIPH_ENABLE_NCP5623_LED define HAL_PERIPH_ENABLE_NCP5623_BGR_LED
define HAL_PERIPH_ENABLE_BARO define HAL_PERIPH_ENABLE_BARO
# I2C Airspeed sensor must use a different address than 0x77 # I2C Airspeed sensor must use a different address than 0x77
define HAL_PERIPH_ENABLE_AIRSPEED define HAL_PERIPH_ENABLE_AIRSPEED

2
libraries/AP_HAL_ChibiOS/hwdef/f303-M10070/hwdef.dat
View File

@ -18,7 +18,7 @@ BARO DPS280 I2C:0:0x77
# GPS+MAG+LED+Baro # GPS+MAG+LED+Baro
define HAL_PERIPH_ENABLE_GPS define HAL_PERIPH_ENABLE_GPS
define HAL_PERIPH_ENABLE_MAG define HAL_PERIPH_ENABLE_MAG
define HAL_PERIPH_ENABLE_NCP5623_LED define HAL_PERIPH_ENABLE_NCP5623_BGR_LED
define HAL_PERIPH_ENABLE_BARO define HAL_PERIPH_ENABLE_BARO
# Optional I2C Airspeed sensor connected to I2C connector # Optional I2C Airspeed sensor connected to I2C connector