Fix Phantom sleep LED.

1 files changed, 21 insertions, 6 deletions

diff --git a/keyboard/phantom/led.c b/keyboard/phantom/led.c
index 109004ba8..f4e9108f0 100644
--- 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);
+        PORTB |= (1<<6);
+    }
+    else
+    {
+        // Output low.
+        DDRB &= ~(1<<6);
+        PORTB &= ~(1<<6);
+    }
 
-    if (!(usb_led & (1<<USB_LED_SCROLL_LOCK)))
+    if (usb_led & (1<<USB_LED_SCROLL_LOCK))
+    {
+        // Output high.
         DDRB &= ~(1<<7);
+        PORTB |= (1<<7);
+    }
     else
-        DDRB |= (1<<7);
+    {
+        // Output low.
+        DDRB &= ~(1<<7);
+        PORTB &= ~(1<<7);
+    }
 }