Add option 7bit data to serial_soft.c

[tmk_firmware.git] / keyboard / phantom / led.c

diff --git a/keyboard/phantom/led.c b/keyboard/phantom/led.c
index 109004ba89ee6389e1cc5013bc4d04a4680ed386..41582b6aafa365a3a7449e959222177c7b00ed74 100644 (file)
--- a/keyboard/phantom/led.c
+++ b/keyboard/phantom/led.c
@@ -16,19 +16,34 @@ along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */
 
 #include <avr/io.h>
-#include "stdint.h"
 #include "led.h"
 
 
 void led_set(uint8_t usb_led)
 {
-    if (!(usb_led & (1<<USB_LED_CAPS_LOCK)))
-        DDRB &= ~(1<<6);
-    else
+    if (usb_led & (1<<USB_LED_CAPS_LOCK))
+    {
+        // Output high.
         DDRB |= (1<<6);
-
-    if (!(usb_led & (1<<USB_LED_SCROLL_LOCK)))
-        DDRB &= ~(1<<7);
+        PORTB |= (1<<6);
+    }
     else
+    {
+        // Output low.
+        DDRB &= ~(1<<6);
+        PORTB &= ~(1<<6);
+    }
+
+    if (usb_led & (1<<USB_LED_SCROLL_LOCK))
+    {
+        // Output high.
         DDRB |= (1<<7);
+        PORTB |= (1<<7);
+    }
+    else
+    {
+        // Output low.
+        DDRB &= ~(1<<7);
+        PORTB &= ~(1<<7);
+    }
 }