Takumi Odashima / ArduinoUsbHostShield

Dependents:   USBHOST_PS5

Committer:
robo_ichinoseki_a
Date:
Sat May 02 05:56:48 2020 +0000
Revision:
1:da31140f2a1c
Parent:
0:b1ce54272580
update

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kotakku 0:b1ce54272580 1 /* Copyright (C) 2014 Kristian Lauszus, TKJ Electronics. All rights reserved.
kotakku 0:b1ce54272580 2
kotakku 0:b1ce54272580 3 This software may be distributed and modified under the terms of the GNU
kotakku 0:b1ce54272580 4 General Public License version 2 (GPL2) as published by the Free Software
kotakku 0:b1ce54272580 5 Foundation and appearing in the file GPL2.TXT included in the packaging of
kotakku 0:b1ce54272580 6 this file. Please note that GPL2 Section 2[b] requires that all works based
kotakku 0:b1ce54272580 7 on this software must also be made publicly available under the terms of
kotakku 0:b1ce54272580 8 the GPL2 ("Copyleft").
kotakku 0:b1ce54272580 9
kotakku 0:b1ce54272580 10 Contact information
kotakku 0:b1ce54272580 11 -------------------
kotakku 0:b1ce54272580 12
kotakku 0:b1ce54272580 13 Kristian Lauszus, TKJ Electronics
kotakku 0:b1ce54272580 14 Web : http://www.tkjelectronics.com
kotakku 0:b1ce54272580 15 e-mail : kristianl@tkjelectronics.com
kotakku 0:b1ce54272580 16 */
kotakku 0:b1ce54272580 17
kotakku 0:b1ce54272580 18 #include "PSBuzz.h"
kotakku 0:b1ce54272580 19
kotakku 0:b1ce54272580 20 // To enable serial debugging see "settings.h"
kotakku 0:b1ce54272580 21 //#define PRINTREPORT // Uncomment to print the report send by the PS Buzz Controllers
kotakku 0:b1ce54272580 22
kotakku 0:b1ce54272580 23 void PSBuzz::ParseHIDData(USBHID *hid __attribute__((unused)), bool is_rpt_id __attribute__((unused)), uint8_t len, uint8_t *buf) {
kotakku 0:b1ce54272580 24 if (HIDUniversal::VID == PSBUZZ_VID && HIDUniversal::PID == PSBUZZ_PID && len > 2 && buf) {
kotakku 0:b1ce54272580 25 #ifdef PRINTREPORT
kotakku 0:b1ce54272580 26 Notify(PSTR("\r\n"), 0x80);
kotakku 0:b1ce54272580 27 for (uint8_t i = 0; i < len; i++) {
kotakku 0:b1ce54272580 28 D_PrintHex<uint8_t > (buf[i], 0x80);
kotakku 0:b1ce54272580 29 Notify(PSTR(" "), 0x80);
kotakku 0:b1ce54272580 30 }
kotakku 0:b1ce54272580 31 #endif
kotakku 0:b1ce54272580 32 memcpy(&psbuzzButtons, buf + 2, min((uint8_t)(len - 2), MFK_CASTUINT8T sizeof(psbuzzButtons)));
kotakku 0:b1ce54272580 33
kotakku 0:b1ce54272580 34 if (psbuzzButtons.val != oldButtonState.val) { // Check if anything has changed
kotakku 0:b1ce54272580 35 buttonClickState.val = psbuzzButtons.val & ~oldButtonState.val; // Update click state variable
kotakku 0:b1ce54272580 36 oldButtonState.val = psbuzzButtons.val;
kotakku 0:b1ce54272580 37 }
kotakku 0:b1ce54272580 38 }
kotakku 0:b1ce54272580 39 };
kotakku 0:b1ce54272580 40
kotakku 0:b1ce54272580 41 uint8_t PSBuzz::OnInitSuccessful() {
kotakku 0:b1ce54272580 42 if (HIDUniversal::VID == PSBUZZ_VID && HIDUniversal::PID == PSBUZZ_PID) {
kotakku 0:b1ce54272580 43 Reset();
kotakku 0:b1ce54272580 44 if (pFuncOnInit)
kotakku 0:b1ce54272580 45 pFuncOnInit(); // Call the user function
kotakku 0:b1ce54272580 46 else
kotakku 0:b1ce54272580 47 setLedOnAll(); // Turn the LED on, on all four controllers
kotakku 0:b1ce54272580 48 };
kotakku 0:b1ce54272580 49 return 0;
kotakku 0:b1ce54272580 50 };
kotakku 0:b1ce54272580 51
kotakku 0:b1ce54272580 52 bool PSBuzz::getButtonPress(ButtonEnum b, uint8_t controller) {
kotakku 0:b1ce54272580 53 return psbuzzButtons.val & (1UL << (b + 5 * controller)); // Each controller uses 5 bits, so the value is shifted 5 for each controller
kotakku 0:b1ce54272580 54 };
kotakku 0:b1ce54272580 55
kotakku 0:b1ce54272580 56 bool PSBuzz::getButtonClick(ButtonEnum b, uint8_t controller) {
kotakku 0:b1ce54272580 57 uint32_t mask = (1UL << (b + 5 * controller)); // Each controller uses 5 bits, so the value is shifted 5 for each controller
kotakku 0:b1ce54272580 58 bool click = buttonClickState.val & mask;
kotakku 0:b1ce54272580 59 buttonClickState.val &= ~mask; // Clear "click" event
kotakku 0:b1ce54272580 60 return click;
kotakku 0:b1ce54272580 61 };
kotakku 0:b1ce54272580 62
kotakku 0:b1ce54272580 63 // Source: http://www.developerfusion.com/article/84338/making-usb-c-friendly/ and https://github.com/torvalds/linux/blob/master/drivers/hid/hid-sony.c
kotakku 0:b1ce54272580 64 void PSBuzz::setLedRaw(bool value, uint8_t controller) {
kotakku 0:b1ce54272580 65 ledState[controller] = value; // Save value for next time it is called
kotakku 0:b1ce54272580 66
kotakku 0:b1ce54272580 67 uint8_t buf[7];
kotakku 0:b1ce54272580 68 buf[0] = 0x00;
kotakku 0:b1ce54272580 69 buf[1] = ledState[0] ? 0xFF : 0x00;
kotakku 0:b1ce54272580 70 buf[2] = ledState[1] ? 0xFF : 0x00;
kotakku 0:b1ce54272580 71 buf[3] = ledState[2] ? 0xFF : 0x00;
kotakku 0:b1ce54272580 72 buf[4] = ledState[3] ? 0xFF : 0x00;
kotakku 0:b1ce54272580 73 buf[5] = 0x00;
kotakku 0:b1ce54272580 74 buf[6] = 0x00;
kotakku 0:b1ce54272580 75
kotakku 0:b1ce54272580 76 PSBuzz_Command(buf, sizeof(buf));
kotakku 0:b1ce54272580 77 };
kotakku 0:b1ce54272580 78
kotakku 0:b1ce54272580 79 void PSBuzz::PSBuzz_Command(uint8_t *data, uint16_t nbytes) {
kotakku 0:b1ce54272580 80 // 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)
kotakku 0:b1ce54272580 81 pUsb->ctrlReq(bAddress, epInfo[0].epAddr, bmREQ_HID_OUT, HID_REQUEST_SET_REPORT, 0x00, 0x02, 0x00, nbytes, nbytes, data, NULL);
kotakku 0:b1ce54272580 82 };
kotakku 0:b1ce54272580 83