From d8501c4031ab215f09ab1f38c57143612edb7e3c Mon Sep 17 00:00:00 2001
From: Peter Hall <33176108+IamPete1@users.noreply.github.com>
Date: Sat, 22 Feb 2020 23:53:31 +0000
Subject: [PATCH] AP_SerialLED: support ProfiLEDs

---
 libraries/AP_SerialLED/AP_SerialLED.cpp | 32 ++++++++++++++++++++-----
 libraries/AP_SerialLED/AP_SerialLED.h   |  7 +++---
 2 files changed, 30 insertions(+), 9 deletions(-)

diff --git a/libraries/AP_SerialLED/AP_SerialLED.cpp b/libraries/AP_SerialLED/AP_SerialLED.cpp
index 247c211169..26a4991eaf 100644
--- a/libraries/AP_SerialLED/AP_SerialLED.cpp
+++ b/libraries/AP_SerialLED/AP_SerialLED.cpp
@@ -18,6 +18,7 @@
 
 #include "AP_SerialLED.h"
 #include <AP_Math/AP_Math.h>
+#include "SRV_Channel/SRV_Channel.h"
 
 extern const AP_HAL::HAL& hal;
 
@@ -27,11 +28,27 @@ AP_SerialLED::AP_SerialLED()
 {
 }
 
-// set number of LEDs per pin
-bool AP_SerialLED::set_num_LEDs(uint8_t chan, uint8_t num_leds)
+// set number of NeoPixels per pin
+bool AP_SerialLED::set_num_neopixel(uint8_t chan, uint8_t num_leds)
 {
     if (chan >= 1 && chan <= 16 && num_leds <= AP_SERIALLED_MAX_LEDS) {
-        return hal.rcout->set_neopixel_num_LEDs(chan-1, num_leds);
+        return hal.rcout->set_serial_led_num_LEDs(chan-1, num_leds, AP_HAL::RCOutput::MODE_NEOPIXEL);
+    }
+    return false;
+}
+
+// set number of ProfiLEDs per pin
+bool AP_SerialLED::set_num_profiled(uint8_t chan, uint8_t num_leds)
+{
+    if (chan >= 1 && chan <= 16 && num_leds <= AP_SERIALLED_MAX_LEDS - 2) {
+        // must have a clock
+        uint16_t Clock_mask = 0;
+        if (!SRV_Channels::function_assigned((SRV_Channel::Aux_servo_function_t)((uint8_t)SRV_Channel::k_ProfiLED_Clock))) {
+            return false;
+        }
+        Clock_mask = SRV_Channels::get_output_channel_mask((SRV_Channel::Aux_servo_function_t)((uint8_t)SRV_Channel::k_ProfiLED_Clock));
+
+        return hal.rcout->set_serial_led_num_LEDs(chan-1, num_leds, AP_HAL::RCOutput::MODE_PROFILED, Clock_mask);
     }
     return false;
 }
@@ -40,12 +57,15 @@ bool AP_SerialLED::set_num_LEDs(uint8_t chan, uint8_t num_leds)
 void AP_SerialLED::set_RGB(uint8_t chan, int8_t led, uint8_t red, uint8_t green, uint8_t blue)
 {
     if (chan >= 1 && chan <= 16) {
-        hal.rcout->set_neopixel_rgb_data(chan-1, led, red, green, blue);
+        hal.rcout->set_serial_led_rgb_data(chan-1, led, red, green, blue);
     }
 }
 
 // trigger sending of LED changes to LEDs
-void AP_SerialLED::send(void)
+void AP_SerialLED::send(uint8_t chan)
 {
-    hal.rcout->neopixel_send();
+    if (chan >= 1 && chan <= 16) {
+        hal.rcout->serial_led_send(chan-1);
+    }
+
 }
diff --git a/libraries/AP_SerialLED/AP_SerialLED.h b/libraries/AP_SerialLED/AP_SerialLED.h
index a7f8d229b2..dac418af70 100644
--- a/libraries/AP_SerialLED/AP_SerialLED.h
+++ b/libraries/AP_SerialLED/AP_SerialLED.h
@@ -21,14 +21,15 @@
 
 // limit number of LEDs, mostly to keep DMA memory consumption within
 // reasonable bounds
-#define AP_SERIALLED_MAX_LEDS 64
+#define AP_SERIALLED_MAX_LEDS 128
 
 class AP_SerialLED {
 public:
     AP_SerialLED();
 
     // set number of LEDs per pin
-    bool set_num_LEDs(uint8_t chan, uint8_t num_leds);
+    bool set_num_neopixel(uint8_t chan, uint8_t num_leds);
+    bool set_num_profiled(uint8_t chan, uint8_t num_leds);
 
     // set RGB value on mask of LEDs. chan is PWM output, 1..16
     void set_RGB_mask(uint8_t chan, uint32_t ledmask, uint8_t red, uint8_t green, uint8_t blue);
@@ -37,7 +38,7 @@ public:
     void set_RGB(uint8_t chan, int8_t led, uint8_t red, uint8_t green, uint8_t blue);
     
     // trigger sending of LED changes to LEDs
-    void send(void);
+    void send(uint8_t chan);
 
     // singleton support
     static AP_SerialLED *get_singleton(void) {