606 lines
		
	
	
	
		
			17 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			606 lines
		
	
	
	
		
			17 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /* 
 | |
|  * Copyright 2012 Jun Wako <wakojun@gmail.com>
 | |
|  * This file is based on:
 | |
|  *     LUFA-120219/Demos/Device/Lowlevel/KeyboardMouse
 | |
|  *     LUFA-120219/Demos/Device/Lowlevel/GenericHID
 | |
|  */
 | |
| 
 | |
| /*
 | |
|              LUFA Library
 | |
|      Copyright (C) Dean Camera, 2012.
 | |
| 
 | |
|   dean [at] fourwalledcubicle [dot] com
 | |
|            www.lufa-lib.org
 | |
| */
 | |
| 
 | |
| /*
 | |
|   Copyright 2012  Dean Camera (dean [at] fourwalledcubicle [dot] com)
 | |
|   Copyright 2010  Denver Gingerich (denver [at] ossguy [dot] com)
 | |
| 
 | |
|   Permission to use, copy, modify, distribute, and sell this
 | |
|   software and its documentation for any purpose is hereby granted
 | |
|   without fee, provided that the above copyright notice appear in
 | |
|   all copies and that both that the copyright notice and this
 | |
|   permission notice and warranty disclaimer appear in supporting
 | |
|   documentation, and that the name of the author not be used in
 | |
|   advertising or publicity pertaining to distribution of the
 | |
|   software without specific, written prior permission.
 | |
| 
 | |
|   The author disclaim all warranties with regard to this
 | |
|   software, including all implied warranties of merchantability
 | |
|   and fitness.  In no event shall the author be liable for any
 | |
|   special, indirect or consequential damages or any damages
 | |
|   whatsoever resulting from loss of use, data or profits, whether
 | |
|   in an action of contract, negligence or other tortious action,
 | |
|   arising out of or in connection with the use or performance of
 | |
|   this software.
 | |
| */
 | |
| 
 | |
| #include <avr/sleep.h>
 | |
| #include <avr/wdt.h>
 | |
| #include "report.h"
 | |
| #include "host.h"
 | |
| #include "host_driver.h"
 | |
| #include "keyboard.h"
 | |
| #include "action.h"
 | |
| #include "matrix.h"
 | |
| #include "led.h"
 | |
| #include "sendchar.h"
 | |
| #include "debug.h"
 | |
| #ifdef SLEEP_LED_ENABLE
 | |
| #include "sleep_led.h"
 | |
| #endif
 | |
| 
 | |
| #include "descriptor.h"
 | |
| #include "lufa.h"
 | |
| 
 | |
| static uint8_t idle_duration = 0;
 | |
| static uint8_t protocol_report = 1;
 | |
| static uint8_t keyboard_led_stats = 0;
 | |
| 
 | |
| static report_keyboard_t keyboard_report_sent;
 | |
| 
 | |
| 
 | |
| /* Host driver */
 | |
| static uint8_t keyboard_leds(void);
 | |
| static void send_keyboard(report_keyboard_t *report);
 | |
| static void send_mouse(report_mouse_t *report);
 | |
| static void send_system(uint16_t data);
 | |
| static void send_consumer(uint16_t data);
 | |
| host_driver_t lufa_driver = {
 | |
|     keyboard_leds,
 | |
|     send_keyboard,
 | |
|     send_mouse,
 | |
|     send_system,
 | |
|     send_consumer
 | |
| };
 | |
| 
 | |
| 
 | |
| /*******************************************************************************
 | |
|  * Console
 | |
|  ******************************************************************************/
 | |
| #ifdef CONSOLE_ENABLE
 | |
| static void Console_Task(void)
 | |
| {
 | |
|     /* Device must be connected and configured for the task to run */
 | |
|     if (USB_DeviceState != DEVICE_STATE_Configured)
 | |
|         return;
 | |
| 
 | |
|     uint8_t ep = Endpoint_GetCurrentEndpoint();
 | |
| 
 | |
| #if 0
 | |
|     // TODO: impl receivechar()/recvchar()
 | |
|     Endpoint_SelectEndpoint(CONSOLE_OUT_EPNUM);
 | |
| 
 | |
|     /* Check to see if a packet has been sent from the host */
 | |
|     if (Endpoint_IsOUTReceived())
 | |
|     {
 | |
|         /* Check to see if the packet contains data */
 | |
|         if (Endpoint_IsReadWriteAllowed())
 | |
|         {
 | |
|             /* Create a temporary buffer to hold the read in report from the host */
 | |
|             uint8_t ConsoleData[CONSOLE_EPSIZE];
 | |
|  
 | |
|             /* Read Console Report Data */
 | |
|             Endpoint_Read_Stream_LE(&ConsoleData, sizeof(ConsoleData), NULL);
 | |
|  
 | |
|             /* Process Console Report Data */
 | |
|             //ProcessConsoleHIDReport(ConsoleData);
 | |
|         }
 | |
| 
 | |
|         /* Finalize the stream transfer to send the last packet */
 | |
|         Endpoint_ClearOUT();
 | |
|     }
 | |
| #endif
 | |
| 
 | |
|     /* IN packet */
 | |
|     Endpoint_SelectEndpoint(CONSOLE_IN_EPNUM);
 | |
|     if (!Endpoint_IsEnabled() || !Endpoint_IsConfigured()) {
 | |
|         Endpoint_SelectEndpoint(ep);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     // fill empty bank
 | |
|     while (Endpoint_IsReadWriteAllowed())
 | |
|         Endpoint_Write_8(0);
 | |
| 
 | |
|     // flash senchar packet
 | |
|     if (Endpoint_IsINReady()) {
 | |
|         Endpoint_ClearIN();
 | |
|     }
 | |
| 
 | |
|     Endpoint_SelectEndpoint(ep);
 | |
| }
 | |
| #else
 | |
| static void Console_Task(void)
 | |
| {
 | |
| }
 | |
| #endif
 | |
| 
 | |
| 
 | |
| /*******************************************************************************
 | |
|  * USB Events
 | |
|  ******************************************************************************/
 | |
| /*
 | |
|  * Event Order of Plug in:
 | |
|  * 0) EVENT_USB_Device_Connect
 | |
|  * 1) EVENT_USB_Device_Suspend
 | |
|  * 2) EVENT_USB_Device_Reset
 | |
|  * 3) EVENT_USB_Device_Wake
 | |
| */
 | |
| void EVENT_USB_Device_Connect(void)
 | |
| {
 | |
|     led_set(0x1f);  // all on
 | |
| }
 | |
| 
 | |
| void EVENT_USB_Device_Disconnect(void)
 | |
| {
 | |
| }
 | |
| 
 | |
| void EVENT_USB_Device_Reset(void)
 | |
| {
 | |
| }
 | |
| 
 | |
| void EVENT_USB_Device_Suspend()
 | |
| {
 | |
| #ifdef SLEEP_LED_ENABLE
 | |
|     sleep_led_enable();
 | |
| #endif
 | |
| }
 | |
| 
 | |
| void EVENT_USB_Device_WakeUp()
 | |
| {
 | |
|     // initialize
 | |
|     matrix_init();
 | |
|     clear_keyboard();
 | |
| 
 | |
| #ifdef SLEEP_LED_ENABLE
 | |
|     sleep_led_disable();
 | |
| #endif
 | |
|     led_set(host_keyboard_leds());
 | |
| }
 | |
| 
 | |
| void EVENT_USB_Device_StartOfFrame(void)
 | |
| {
 | |
|     Console_Task();
 | |
| }
 | |
| 
 | |
| /** Event handler for the USB_ConfigurationChanged event.
 | |
|  * This is fired when the host sets the current configuration of the USB device after enumeration.
 | |
|  */
 | |
| #if LUFA_VERSION_INTEGER < 0x120730
 | |
|     /* old API 120219 */
 | |
|     #define ENDPOINT_CONFIG(epnum, eptype, epdir, epsize, epbank)    Endpoint_ConfigureEndpoint(epnum, eptype, epdir, epsize, epbank)
 | |
| #else
 | |
|     /* new API >= 120730 */
 | |
|     #define ENDPOINT_BANK_SINGLE 1
 | |
|     #define ENDPOINT_BANK_DOUBLE 2
 | |
|     #define ENDPOINT_CONFIG(epnum, eptype, epdir, epsize, epbank)    Endpoint_ConfigureEndpoint((epdir) | (epnum) , eptype, epsize, epbank)
 | |
| #endif
 | |
| void EVENT_USB_Device_ConfigurationChanged(void)
 | |
| {
 | |
|     bool ConfigSuccess = true;
 | |
| 
 | |
|     /* Setup Keyboard HID Report Endpoints */
 | |
|     ConfigSuccess &= ENDPOINT_CONFIG(KEYBOARD_IN_EPNUM, EP_TYPE_INTERRUPT, ENDPOINT_DIR_IN,
 | |
|                                      KEYBOARD_EPSIZE, ENDPOINT_BANK_SINGLE);
 | |
| 
 | |
| #ifdef MOUSE_ENABLE
 | |
|     /* Setup Mouse HID Report Endpoint */
 | |
|     ConfigSuccess &= ENDPOINT_CONFIG(MOUSE_IN_EPNUM, EP_TYPE_INTERRUPT, ENDPOINT_DIR_IN,
 | |
|                                      MOUSE_EPSIZE, ENDPOINT_BANK_SINGLE);
 | |
| #endif
 | |
| 
 | |
| #ifdef EXTRAKEY_ENABLE
 | |
|     /* Setup Extra HID Report Endpoint */
 | |
|     ConfigSuccess &= ENDPOINT_CONFIG(EXTRAKEY_IN_EPNUM, EP_TYPE_INTERRUPT, ENDPOINT_DIR_IN,
 | |
|                                      EXTRAKEY_EPSIZE, ENDPOINT_BANK_SINGLE);
 | |
| #endif
 | |
| 
 | |
| #ifdef CONSOLE_ENABLE
 | |
|     /* Setup Console HID Report Endpoints */
 | |
|     ConfigSuccess &= ENDPOINT_CONFIG(CONSOLE_IN_EPNUM, EP_TYPE_INTERRUPT, ENDPOINT_DIR_IN,
 | |
|                                      CONSOLE_EPSIZE, ENDPOINT_BANK_DOUBLE);
 | |
|     ConfigSuccess &= ENDPOINT_CONFIG(CONSOLE_OUT_EPNUM, EP_TYPE_INTERRUPT, ENDPOINT_DIR_OUT,
 | |
|                                      CONSOLE_EPSIZE, ENDPOINT_BANK_SINGLE);
 | |
| #endif
 | |
| }
 | |
| 
 | |
| /*
 | |
| Appendix G: HID Request Support Requirements
 | |
| 
 | |
| The following table enumerates the requests that need to be supported by various types of HID class devices.
 | |
| 
 | |
| Device type     GetReport   SetReport   GetIdle     SetIdle     GetProtocol SetProtocol
 | |
| ------------------------------------------------------------------------------------------
 | |
| Boot Mouse      Required    Optional    Optional    Optional    Required    Required
 | |
| Non-Boot Mouse  Required    Optional    Optional    Optional    Optional    Optional
 | |
| Boot Keyboard   Required    Optional    Required    Required    Required    Required
 | |
| Non-Boot Keybrd Required    Optional    Required    Required    Optional    Optional
 | |
| Other Device    Required    Optional    Optional    Optional    Optional    Optional
 | |
| */
 | |
| /** Event handler for the USB_ControlRequest event.
 | |
|  *  This is fired before passing along unhandled control requests to the library for processing internally.
 | |
|  */
 | |
| void EVENT_USB_Device_ControlRequest(void)
 | |
| {
 | |
|     uint8_t* ReportData = NULL;
 | |
|     uint8_t  ReportSize = 0;
 | |
| 
 | |
|     /* Handle HID Class specific requests */
 | |
|     switch (USB_ControlRequest.bRequest)
 | |
|     {
 | |
|         case HID_REQ_GetReport:
 | |
|             if (USB_ControlRequest.bmRequestType == (REQDIR_DEVICETOHOST | REQTYPE_CLASS | REQREC_INTERFACE))
 | |
|             {
 | |
|                 Endpoint_ClearSETUP();
 | |
| 
 | |
|                 // Interface
 | |
|                 switch (USB_ControlRequest.wIndex) {
 | |
|                 case KEYBOARD_INTERFACE:
 | |
|                     // TODO: test/check
 | |
|                     ReportData = (uint8_t*)&keyboard_report_sent;
 | |
|                     ReportSize = sizeof(keyboard_report_sent);
 | |
|                     break;
 | |
|                 }
 | |
| 
 | |
|                 /* Write the report data to the control endpoint */
 | |
|                 Endpoint_Write_Control_Stream_LE(ReportData, ReportSize);
 | |
|                 Endpoint_ClearOUT();
 | |
|             }
 | |
| 
 | |
|             break;
 | |
|         case HID_REQ_SetReport:
 | |
|             if (USB_ControlRequest.bmRequestType == (REQDIR_HOSTTODEVICE | REQTYPE_CLASS | REQREC_INTERFACE))
 | |
|             {
 | |
| 
 | |
|                 // Interface
 | |
|                 switch (USB_ControlRequest.wIndex) {
 | |
|                 case KEYBOARD_INTERFACE:
 | |
|                     Endpoint_ClearSETUP();
 | |
| 
 | |
|                     while (!(Endpoint_IsOUTReceived())) {
 | |
|                         if (USB_DeviceState == DEVICE_STATE_Unattached)
 | |
|                           return;
 | |
|                     }
 | |
|                     keyboard_led_stats = Endpoint_Read_8();
 | |
| 
 | |
|                     Endpoint_ClearOUT();
 | |
|                     Endpoint_ClearStatusStage();
 | |
|                     break;
 | |
|                 }
 | |
| 
 | |
|             }
 | |
| 
 | |
|             break;
 | |
| 
 | |
|         case HID_REQ_GetProtocol:
 | |
|             if (USB_ControlRequest.bmRequestType == (REQDIR_DEVICETOHOST | REQTYPE_CLASS | REQREC_INTERFACE))
 | |
|             {
 | |
|                 Endpoint_ClearSETUP();
 | |
|                 while (!(Endpoint_IsINReady()));
 | |
|                 Endpoint_Write_8(protocol_report);
 | |
|                 Endpoint_ClearIN();
 | |
|                 Endpoint_ClearStatusStage();
 | |
|             }
 | |
| 
 | |
|             break;
 | |
|         case HID_REQ_SetProtocol:
 | |
|             if (USB_ControlRequest.bmRequestType == (REQDIR_HOSTTODEVICE | REQTYPE_CLASS | REQREC_INTERFACE))
 | |
|             {
 | |
|                 Endpoint_ClearSETUP();
 | |
|                 Endpoint_ClearStatusStage();
 | |
| 
 | |
|                 protocol_report = ((USB_ControlRequest.wValue & 0xFF) != 0x00);
 | |
|             }
 | |
| 
 | |
|             break;
 | |
|         case HID_REQ_SetIdle:
 | |
|             if (USB_ControlRequest.bmRequestType == (REQDIR_HOSTTODEVICE | REQTYPE_CLASS | REQREC_INTERFACE))
 | |
|             {
 | |
|                 Endpoint_ClearSETUP();
 | |
|                 Endpoint_ClearStatusStage();
 | |
| 
 | |
|                 idle_duration = ((USB_ControlRequest.wValue & 0xFF00) >> 8);
 | |
|             }
 | |
| 
 | |
|             break;
 | |
|         case HID_REQ_GetIdle:
 | |
|             if (USB_ControlRequest.bmRequestType == (REQDIR_DEVICETOHOST | REQTYPE_CLASS | REQREC_INTERFACE))
 | |
|             {
 | |
|                 Endpoint_ClearSETUP();
 | |
|                 while (!(Endpoint_IsINReady()));
 | |
|                 Endpoint_Write_8(idle_duration);
 | |
|                 Endpoint_ClearIN();
 | |
|                 Endpoint_ClearStatusStage();
 | |
|             }
 | |
| 
 | |
|             break;
 | |
|     }
 | |
| }
 | |
| 
 | |
| /*******************************************************************************
 | |
|  * Host driver 
 | |
|  ******************************************************************************/
 | |
| static uint8_t keyboard_leds(void)
 | |
| {
 | |
|     return keyboard_led_stats;
 | |
| }
 | |
| 
 | |
| static void send_keyboard(report_keyboard_t *report)
 | |
| {
 | |
|     uint8_t timeout = 0;
 | |
| 
 | |
|     // TODO: handle NKRO report
 | |
|     /* Select the Keyboard Report Endpoint */
 | |
|     Endpoint_SelectEndpoint(KEYBOARD_IN_EPNUM);
 | |
| 
 | |
|     /* Check if Keyboard Endpoint Ready for Read/Write */
 | |
|     while (--timeout && !Endpoint_IsReadWriteAllowed()) ;
 | |
| 
 | |
|     /* Write Keyboard Report Data */
 | |
|     Endpoint_Write_Stream_LE(report, sizeof(report_keyboard_t), NULL);
 | |
| 
 | |
|     /* Finalize the stream transfer to send the last packet */
 | |
|     Endpoint_ClearIN();
 | |
| 
 | |
|     keyboard_report_sent = *report;
 | |
| }
 | |
| 
 | |
| static void send_mouse(report_mouse_t *report)
 | |
| {
 | |
| #ifdef MOUSE_ENABLE
 | |
|     uint8_t timeout = 0;
 | |
| 
 | |
|     /* Select the Mouse Report Endpoint */
 | |
|     Endpoint_SelectEndpoint(MOUSE_IN_EPNUM);
 | |
| 
 | |
|     /* Check if Mouse Endpoint Ready for Read/Write */
 | |
|     while (--timeout && !Endpoint_IsReadWriteAllowed()) ;
 | |
| 
 | |
|     /* Write Mouse Report Data */
 | |
|     Endpoint_Write_Stream_LE(report, sizeof(report_mouse_t), NULL);
 | |
| 
 | |
|     /* Finalize the stream transfer to send the last packet */
 | |
|     Endpoint_ClearIN();
 | |
| #endif
 | |
| }
 | |
| 
 | |
| static void send_system(uint16_t data)
 | |
| {
 | |
|     uint8_t timeout = 0;
 | |
| 
 | |
|     report_extra_t r = {
 | |
|         .report_id = REPORT_ID_SYSTEM,
 | |
|         .usage = data
 | |
|     };
 | |
|     Endpoint_SelectEndpoint(EXTRAKEY_IN_EPNUM);
 | |
|     while (--timeout && !Endpoint_IsReadWriteAllowed()) ;
 | |
|     Endpoint_Write_Stream_LE(&r, sizeof(report_extra_t), NULL);
 | |
|     Endpoint_ClearIN();
 | |
| }
 | |
| 
 | |
| static void send_consumer(uint16_t data)
 | |
| {
 | |
|     uint8_t timeout = 0;
 | |
| 
 | |
|     report_extra_t r = {
 | |
|         .report_id = REPORT_ID_CONSUMER,
 | |
|         .usage = data
 | |
|     };
 | |
|     Endpoint_SelectEndpoint(EXTRAKEY_IN_EPNUM);
 | |
|     while (--timeout && !Endpoint_IsReadWriteAllowed()) ;
 | |
|     Endpoint_Write_Stream_LE(&r, sizeof(report_extra_t), NULL);
 | |
|     Endpoint_ClearIN();
 | |
| }
 | |
| 
 | |
| 
 | |
| /*******************************************************************************
 | |
|  * sendchar
 | |
|  ******************************************************************************/
 | |
| #ifdef CONSOLE_ENABLE
 | |
| #define SEND_TIMEOUT 5
 | |
| int8_t sendchar(uint8_t c)
 | |
| {
 | |
|     // Not wait once timeouted.
 | |
|     // Because sendchar() is called so many times, waiting each call causes big lag.
 | |
|     static bool timeouted = false;
 | |
| 
 | |
|     if (USB_DeviceState != DEVICE_STATE_Configured)
 | |
|         return -1;
 | |
| 
 | |
|     uint8_t ep = Endpoint_GetCurrentEndpoint();
 | |
|     Endpoint_SelectEndpoint(CONSOLE_IN_EPNUM);
 | |
|     if (!Endpoint_IsEnabled() || !Endpoint_IsConfigured()) {
 | |
|         Endpoint_SelectEndpoint(ep);
 | |
|         return -1;
 | |
|     }
 | |
| 
 | |
|     if (timeouted && !Endpoint_IsReadWriteAllowed()) {
 | |
|         Endpoint_SelectEndpoint(ep);
 | |
|         return - 1;
 | |
|     }
 | |
| 
 | |
|     timeouted = false;
 | |
| 
 | |
|     uint8_t timeout = SEND_TIMEOUT;
 | |
|     uint16_t prevFN = USB_Device_GetFrameNumber();
 | |
|     while (!Endpoint_IsReadWriteAllowed()) {
 | |
|         switch (USB_DeviceState) {
 | |
|         case DEVICE_STATE_Unattached:
 | |
|         case DEVICE_STATE_Suspended:
 | |
|             return -1;
 | |
|         }
 | |
|         if (Endpoint_IsStalled()) {
 | |
|             Endpoint_SelectEndpoint(ep);
 | |
|             return -1;
 | |
|         }
 | |
|         if (prevFN != USB_Device_GetFrameNumber()) {
 | |
|             if (!(timeout--)) {
 | |
|                 timeouted = true;
 | |
|                 Endpoint_SelectEndpoint(ep);
 | |
|                 return -1;
 | |
|             }
 | |
|             prevFN = USB_Device_GetFrameNumber();
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     Endpoint_Write_8(c);
 | |
| 
 | |
|     // send when bank is full
 | |
|     if (!Endpoint_IsReadWriteAllowed())
 | |
|         Endpoint_ClearIN();
 | |
| 
 | |
|     Endpoint_SelectEndpoint(ep);
 | |
|     return 0;
 | |
| }
 | |
| #else
 | |
| int8_t sendchar(uint8_t c)
 | |
| {
 | |
|     return 0;
 | |
| }
 | |
| #endif
 | |
| 
 | |
| 
 | |
| /*******************************************************************************
 | |
|  * main
 | |
|  ******************************************************************************/
 | |
| static void SetupHardware(void)
 | |
| {
 | |
|     /* Disable watchdog if enabled by bootloader/fuses */
 | |
|     MCUSR &= ~(1 << WDRF);
 | |
|     wdt_disable();
 | |
| 
 | |
|     /* Disable clock division */
 | |
|     clock_prescale_set(clock_div_1);
 | |
| 
 | |
|     // Leonardo needs. Without this USB device is not recognized.
 | |
|     USB_Disable();
 | |
| 
 | |
|     USB_Init();
 | |
| 
 | |
|     // for Console_Task
 | |
|     USB_Device_EnableSOFEvents();
 | |
| }
 | |
| 
 | |
| 
 | |
| static bool wakeup_condition(void)
 | |
| {
 | |
|     matrix_scan();
 | |
|     for (uint8_t r = 0; r < MATRIX_ROWS; r++) {
 | |
|         if (matrix_get_row(r)) return true;
 | |
|     }
 | |
|     return false;
 | |
| }
 | |
| 
 | |
| #define wdt_intr_enable(value)   \
 | |
| __asm__ __volatile__ (  \
 | |
|     "in __tmp_reg__,__SREG__" "\n\t"    \
 | |
|     "cli" "\n\t"    \
 | |
|     "wdr" "\n\t"    \
 | |
|     "sts %0,%1" "\n\t"  \
 | |
|     "out __SREG__,__tmp_reg__" "\n\t"   \
 | |
|     "sts %0,%2" "\n\t" \
 | |
|     : /* no outputs */  \
 | |
|     : "M" (_SFR_MEM_ADDR(_WD_CONTROL_REG)), \
 | |
|     "r" (_BV(_WD_CHANGE_BIT) | _BV(WDE)), \
 | |
|     "r" ((uint8_t) ((value & 0x08 ? _WD_PS3_MASK : 0x00) | \
 | |
|         _BV(WDIE) | (value & 0x07)) ) \
 | |
|     : "r0"  \
 | |
| )
 | |
| 
 | |
| int main(void)  __attribute__ ((weak));
 | |
| int main(void)
 | |
| {
 | |
|     SetupHardware();
 | |
|     keyboard_init();
 | |
|     host_set_driver(&lufa_driver);
 | |
| #ifdef SLEEP_LED_ENABLE
 | |
|     sleep_led_init();
 | |
| #endif
 | |
|     sei();
 | |
| 
 | |
|     while (1) {
 | |
|         // while suspend
 | |
|         while (USB_DeviceState == DEVICE_STATE_Suspended) {
 | |
| #ifndef NO_SUSPEND_POWER_DOWN
 | |
|             // Enable watchdog to wake from MCU sleep
 | |
|             cli();
 | |
|             wdt_reset();
 | |
| 
 | |
|             // Watchdog Interrupt and System Reset Mode
 | |
|             //wdt_enable(WDTO_1S);
 | |
|             //WDTCSR |= _BV(WDIE);
 | |
|             
 | |
|             // Watchdog Interrupt Mode
 | |
|             wdt_intr_enable(WDTO_120MS);
 | |
|             
 | |
|             // TODO: more power saving
 | |
|             // See PicoPower application note
 | |
|             // - I/O port input with pullup
 | |
|             // - prescale clock
 | |
|             // - BOD disable
 | |
|             // - Power Reduction Register PRR
 | |
|             // sleep in power down mode
 | |
|             set_sleep_mode(SLEEP_MODE_PWR_DOWN);
 | |
|             sleep_enable();
 | |
|             sei();
 | |
|             sleep_cpu();
 | |
|             sleep_disable();
 | |
| 
 | |
|             // Disable watchdog after sleep
 | |
|             wdt_disable();
 | |
| #endif
 | |
| 
 | |
|             // Send request of USB Wakeup from Suspend to host
 | |
|             if (USB_Device_RemoteWakeupEnabled) {
 | |
|                 if (wakeup_condition()) {
 | |
|                     USB_Device_SendRemoteWakeup();
 | |
|                 }
 | |
|             }
 | |
|         }
 | |
| 
 | |
|         keyboard_task();
 | |
| 
 | |
| #if !defined(INTERRUPT_CONTROL_ENDPOINT)
 | |
|         USB_USBTask();
 | |
| #endif
 | |
|     }
 | |
| }
 | |
| 
 | |
| #ifndef NO_SUSPEND_POWER_DOWN
 | |
| /* watchdog timeout */
 | |
| ISR(WDT_vect)
 | |
| {
 | |
|     /* wakeup from MCU sleep mode */
 | |
| /*
 | |
|     // blink LED
 | |
|     static uint8_t led_state = 0;
 | |
|     static uint8_t led_count = 0;
 | |
|     led_count++;
 | |
|     if ((led_count & 0x07) == 0) {
 | |
|         led_set((led_state ^= (1<<USB_LED_CAPS_LOCK)));
 | |
|     }
 | |
| */
 | |
| }
 | |
| #endif
 | 
