123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174 |
- #include <stdint.h>
- #include <avr/interrupt.h>
- #include <avr/power.h>
- #include <avr/wdt.h>
- #include <avr/sleep.h>
- #include <usbdrv/usbdrv.h>
- #include "vusb.h"
- #include "keyboard.h"
- #include "host.h"
- #include "timer.h"
- #include "print.h"
- #include "suspend.h"
- #include "wait.h"
- #include "sendchar.h"
- #ifdef SLEEP_LED_ENABLE
- # include "sleep_led.h"
- #endif
- #ifdef CONSOLE_ENABLE
- void console_task(void);
- #endif
- #ifdef RAW_ENABLE
- void raw_hid_task(void);
- #endif
- static void initForUsbConnectivity(void) {
- uint8_t i = 0;
- usbInit();
-
- usbDeviceDisconnect();
- while (--i) {
- wdt_reset();
- wait_ms(1);
- }
- usbDeviceConnect();
- }
- static void vusb_send_remote_wakeup(void) {
- cli();
- uint8_t ddr_orig = USBDDR;
- USBOUT |= (1 << USBMINUS);
- USBDDR = ddr_orig | USBMASK;
- USBOUT ^= USBMASK;
- wait_ms(25);
- USBOUT ^= USBMASK;
- USBDDR = ddr_orig;
- USBOUT &= ~(1 << USBMINUS);
- sei();
- }
- bool vusb_suspended = false;
- static void vusb_suspend(void) {
- vusb_suspended = true;
- #ifdef SLEEP_LED_ENABLE
- sleep_led_enable();
- #endif
- suspend_power_down();
- }
- #if USB_COUNT_SOF
- static void vusb_wakeup(void) {
- vusb_suspended = false;
- suspend_wakeup_init();
- # ifdef SLEEP_LED_ENABLE
- sleep_led_disable();
- # endif
- }
- #endif
- static void setup_usb(void) {
- initForUsbConnectivity();
- }
- uint16_t sof_timer = 0;
- void protocol_setup(void) {
- #if USB_COUNT_SOF
- sof_timer = timer_read();
- #endif
- #ifdef CLKPR
-
-
- clock_prescale_set(clock_div_1);
- #endif
- }
- void protocol_pre_init(void) {
- setup_usb();
- sei();
- }
- void protocol_post_init(void) {
- host_set_driver(vusb_driver());
- wait_ms(50);
- }
- void protocol_task(void) {
- #if USB_COUNT_SOF
- if (usbSofCount != 0) {
- usbSofCount = 0;
- sof_timer = timer_read();
- if (vusb_suspended) {
- vusb_wakeup();
- }
- } else {
-
- if (!vusb_suspended && timer_elapsed(sof_timer) > 5) {
- vusb_suspend();
- }
- }
- #endif
- if (vusb_suspended) {
- vusb_suspend();
- if (suspend_wakeup_condition()) {
- vusb_send_remote_wakeup();
- }
- } else {
- usbPoll();
-
-
- if (usbConfiguration && usbInterruptIsReady()) {
- keyboard_task();
- }
- vusb_transfer_keyboard();
- #ifdef RAW_ENABLE
- usbPoll();
- if (usbConfiguration && usbInterruptIsReady4()) {
- raw_hid_task();
- }
- #endif
- #ifdef CONSOLE_ENABLE
- usbPoll();
- if (usbConfiguration && usbInterruptIsReady3()) {
- console_task();
- }
- #endif
- }
- }
|