12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182 |
- #include "PSBuzz.h"
- void PSBuzz::ParseHIDData(HID *hid, bool is_rpt_id, 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<uint8_t > (buf[i], 0x80);
- Notify(PSTR(" "), 0x80);
- }
- #endif
- memcpy(&psbuzzButtons, buf + 2, min((uint8_t)(len - 2), sizeof(psbuzzButtons)));
- if (psbuzzButtons.val != oldButtonState.val) {
- buttonClickState.val = psbuzzButtons.val & ~oldButtonState.val;
- oldButtonState.val = psbuzzButtons.val;
- }
- }
- };
- uint8_t PSBuzz::OnInitSuccessful() {
- if (HIDUniversal::VID == PSBUZZ_VID && HIDUniversal::PID == PSBUZZ_PID) {
- Reset();
- if (pFuncOnInit)
- pFuncOnInit();
- else
- setLedOnAll();
- };
- return 0;
- };
- bool PSBuzz::getButtonPress(ButtonEnum b, uint8_t controller) {
- return psbuzzButtons.val & (1UL << (b + 5 * controller));
- };
- bool PSBuzz::getButtonClick(ButtonEnum b, uint8_t controller) {
- uint32_t mask = (1UL << (b + 5 * controller));
- bool click = buttonClickState.val & mask;
- buttonClickState.val &= ~mask;
- return click;
- };
- void PSBuzz::setLedRaw(bool value, uint8_t controller) {
- ledState[controller] = value;
- 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) {
-
- pUsb->ctrlReq(bAddress, epInfo[0].epAddr, bmREQ_HID_OUT, HID_REQUEST_SET_REPORT, 0x00, 0x02, 0x00, nbytes, nbytes, data, NULL);
- };
|