Add LED feature to Sun converter

[tmk_firmware.git] / converter / sun_usb / led.c

diff --git a/converter/sun_usb/led.c b/converter/sun_usb/led.c
index 5490ec0c624001be5ff4387ef7b27ad37a4932c9..48c3f1c2b29224f09fa305cebf1822e0da673148 100644 (file)
--- a/converter/sun_usb/led.c
+++ b/converter/sun_usb/led.c
@@ -16,10 +16,18 @@ along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */
 
 #include "stdint.h"
+#include "serial.h"
 #include "led.h"
 
 
 void led_set(uint8_t usb_led)
 {
-    // not supported now
+    uint8_t sun_led = 0;
+    if (usb_led & (1<<USB_LED_NUM_LOCK))    sun_led |= (1<<0);
+    if (usb_led & (1<<USB_LED_COMPOSE))     sun_led |= (1<<1);
+    if (usb_led & (1<<USB_LED_SCROLL_LOCK)) sun_led |= (1<<2);
+    if (usb_led & (1<<USB_LED_CAPS_LOCK))   sun_led |= (1<<3);
+
+    serial_send(0x0E);
+    serial_send(sun_led);
 }