orphan/lightsaber/led.c

   1 /*
   2 Copyright 2014 Ralf Schmitt <ralf@bunkertor.net>
   3
   4 This program is free software: you can redistribute it and/or modify
   5 it under the terms of the GNU General Public License as published by
   6 the Free Software Foundation, either version 2 of the License, or
   7 (at your option) any later version.
   8
   9 This program is distributed in the hope that it will be useful,
  10 but WITHOUT ANY WARRANTY; without even the implied warranty of
  11 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12 GNU General Public License for more details.
  13
  14 You should have received a copy of the GNU General Public License
  15 along with this program.  If not, see <http://www.gnu.org/licenses/>.
  16 */
  17
  18 #include <avr/io.h>
  19 #include "stdint.h"
  20 #include "led.h"
  21
  22 /* LED pin configuration
  23  *
  24  * Caps      PB0 (low)
  25  * NumLock   PB4 (low)
  26  *
  27  */
  28 void led_set(uint8_t usb_led)
  29 {
  30     // Set as output.
  31     DDRB |= (1<<0) | (1<<4);
  32
  33     if (usb_led & (1<<USB_LED_CAPS_LOCK))
  34     {
  35         // Output low.
  36         PORTB &= ~(1<<0);
  37     }
  38     else
  39     {
  40         // Output high.
  41         PORTB |= (1<<0);
  42     }
  43
  44     if (usb_led & (1<<USB_LED_NUM_LOCK))
  45     {
  46         // Output low.
  47         PORTB &= ~(1<<4);
  48     }
  49     else
  50     {
  51         // Output high.
  52         PORTB |= (1<<4);
  53     }
  54 }