mirror of
https://github.com/felis/USB_Host_Shield_2.0.git
synced 2024-03-22 11:31:26 +01:00
111 lines
3.8 KiB
C++
111 lines
3.8 KiB
C++
/* Copyright (C) 2021 Kristian Sloth Lauszus and Dennis Frett. 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 Sloth Lauszus
|
|
Web : https://lauszus.com
|
|
e-mail : lauszus@gmail.com
|
|
|
|
Dennis Frett
|
|
GitHub : https://github.com/dennisfrett
|
|
e-mail : dennis.frett@live.com
|
|
*/
|
|
|
|
#include "MiniDSP.h"
|
|
|
|
void MiniDSP::ParseHIDData(USBHID *hid __attribute__ ((unused)), bool is_rpt_id __attribute__ ((unused)), uint8_t len, uint8_t *buf) {
|
|
|
|
constexpr uint8_t StatusInputCommand[] = {0x05, 0xFF, 0xDA};
|
|
|
|
// Only care about valid data for the MiniDSP 2x4HD.
|
|
if(HIDUniversal::VID != MINIDSP_VID || HIDUniversal::PID != MINIDSP_PID || len <= 4 || buf == nullptr)
|
|
return;
|
|
|
|
// Check if this is a status update.
|
|
// First byte is the length, we ignore that for now.
|
|
if(memcmp(buf + 1, StatusInputCommand, sizeof (StatusInputCommand)) == 0) {
|
|
|
|
// Parse data.
|
|
// Response is of format [ length ] [ 0x05 0xFF 0xDA ] [ volume ] [ muted ].
|
|
const auto newVolume = buf[sizeof (StatusInputCommand) + 1];
|
|
const auto newIsMuted = (bool)buf[sizeof (StatusInputCommand) + 2];
|
|
|
|
const auto volumeChanged = newVolume != volume;
|
|
const auto mutedChanged = newIsMuted != muted;
|
|
|
|
// Update status.
|
|
volume = newVolume;
|
|
muted = newIsMuted;
|
|
|
|
// Call callbacks.
|
|
if(pFuncOnVolumeChange != nullptr && volumeChanged)
|
|
pFuncOnVolumeChange(volume);
|
|
|
|
if(pFuncOnMutedChange != nullptr && mutedChanged)
|
|
pFuncOnMutedChange(muted);
|
|
}
|
|
};
|
|
|
|
uint8_t MiniDSP::OnInitSuccessful() {
|
|
// Verify we're actually connected to the MiniDSP 2x4HD.
|
|
if(HIDUniversal::VID != MINIDSP_VID || HIDUniversal::PID != MINIDSP_PID)
|
|
return 0;
|
|
|
|
// Request current status so we can initialize the values.
|
|
RequestStatus();
|
|
|
|
if(pFuncOnInit != nullptr)
|
|
pFuncOnInit();
|
|
|
|
return 0;
|
|
};
|
|
|
|
uint8_t MiniDSP::Checksum(const uint8_t *data, uint8_t data_length) const {
|
|
uint16_t sum = 0;
|
|
for(uint8_t i = 0; i < data_length; i++)
|
|
sum += data[i];
|
|
|
|
return sum & 0xFF;
|
|
}
|
|
|
|
void MiniDSP::SendCommand(uint8_t *command, uint8_t command_length) const {
|
|
// Sanity check on command length.
|
|
if(command_length > 63)
|
|
return;
|
|
|
|
// Message is padded to 64 bytes with 0xFF and is of format:
|
|
// [ length (command + checksum byte) ] [ command ] [ checksum ] [ OxFF... ]
|
|
|
|
// MiniDSP expects 64 byte messages.
|
|
uint8_t buf[64];
|
|
|
|
// Set length, including checksum byte.
|
|
buf[0] = command_length + 1;
|
|
|
|
// Copy actual command.
|
|
memcpy(&buf[1], command, command_length);
|
|
|
|
const auto checksumOffset = command_length + 1;
|
|
|
|
// Set checksum byte.
|
|
buf[checksumOffset] = Checksum(buf, command_length + 1);
|
|
|
|
// Pad the rest.
|
|
memset(&buf[checksumOffset + 1], 0xFF, sizeof (buf) - checksumOffset - 1);
|
|
|
|
pUsb->outTransfer(bAddress, epInfo[epInterruptOutIndex].epAddr, sizeof (buf), buf);
|
|
}
|
|
|
|
void MiniDSP::RequestStatus() const {
|
|
uint8_t RequestStatusOutputCommand[] = {0x05, 0xFF, 0xDA, 0x02};
|
|
|
|
SendCommand(RequestStatusOutputCommand, sizeof (RequestStatusOutputCommand));
|
|
}
|