diff --git a/PS3BT.cpp b/PS3BT.cpp index ab5a8ed5..cf1670bb 100644 --- a/PS3BT.cpp +++ b/PS3BT.cpp @@ -528,12 +528,13 @@ void PS3BT::setAllOff() { } void PS3BT::setRumbleOff() { - HIDBuffer[3] = 0x00; - HIDBuffer[4] = 0x00; - HIDBuffer[5] = 0x00; - HIDBuffer[6] = 0x00; - - HID_Command(HIDBuffer, HID_BUFFERSIZE); + 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) { @@ -546,11 +547,13 @@ void PS3BT::setRumbleOn(RumbleEnum mode) { } void PS3BT::setRumbleOn(uint8_t rightDuration, uint8_t rightPower, uint8_t leftDuration, uint8_t leftPower) { - HIDBuffer[3] = rightDuration; - HIDBuffer[4] = rightPower; - HIDBuffer[5] = leftDuration; - HIDBuffer[6] = leftPower; - HID_Command(HIDBuffer, HID_BUFFERSIZE); + 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) { diff --git a/PS3USB.cpp b/PS3USB.cpp index f247cc91..c263613a 100755 --- a/PS3USB.cpp +++ b/PS3USB.cpp @@ -408,12 +408,13 @@ void PS3USB::setAllOff() { } void PS3USB::setRumbleOff() { - writeBuf[1] = 0x00; - writeBuf[2] = 0x00; // Low mode off - writeBuf[3] = 0x00; - writeBuf[4] = 0x00; // High mode off - - PS3_Command(writeBuf, PS3_REPORT_BUFFER_SIZE); + 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) { @@ -428,11 +429,13 @@ void PS3USB::setRumbleOn(RumbleEnum mode) { } void PS3USB::setRumbleOn(uint8_t rightDuration, uint8_t rightPower, uint8_t leftDuration, uint8_t leftPower) { - writeBuf[1] = rightDuration; - writeBuf[2] = rightPower; - writeBuf[3] = leftDuration; - writeBuf[4] = leftPower; - PS3_Command(writeBuf, PS3_REPORT_BUFFER_SIZE); + 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) {