forked from forks/qmk_firmware
53ff8a31b6
* Move lufa descriptor to protocol/usb_descriptor * Try to compile usb_descriptor on ChibiOS * Add lufa_utils for ChibiOS Lufa USB descriptors for ChibiOS * More lufa_util compatibility fixes * First compiling version of shared USB descriptor * Send the usb descriptors * Fix the CONSOLE output on ChibiOS * Add errors for unsupported interfaces * Enable support for vitual serial port USB descriptors * Implement virtual serial port for ChibiOS * Cleanup the lufa_utils Use the default lufa header files * Add raw hid support for ChibiOS This is completely untested * Enable midi compilation on ChibiOS * Move midi functionality out of lufa.c * Don't register sysex callback when not needed * ChibiOS compilation fixes * Update ChibiOS submodule * Fix the Midi USB descriptor It didn't work properly when both Midi and Virtual serial port was enabled. * Add MIDI support for ChibiOS * Fix USB descriptor strings on ChibiOS * Use serial usb driver for raw hid * Generalize the ChibiOS stream like drivers This makes the initialization much more simple and eliminates a lot of the code duplication. * Convert console output to chibios stream driver * Fixes for ChibiOS update * Update the ChibiOS contrib submodule To include the usb data toggle synchronization fixes * Fix duplicate reset enumeration on ChibiOS * Add missing include * Add number of endpoints check for ChibiOS * Enable serial USB driver on all keyboards * Add missing includes when API is enabled withot midi * Add another missing inlcude
74 lines
3 KiB
C
74 lines
3 KiB
C
/* Copyright 2016 Jack Humbert, Fred Sundvik
|
|
*
|
|
* 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 <http://www.gnu.org/licenses/>.
|
|
*/
|
|
#include "api_sysex.h"
|
|
#include "sysex_tools.h"
|
|
#include "print.h"
|
|
#include "qmk_midi.h"
|
|
|
|
void send_bytes_sysex(uint8_t message_type, uint8_t data_type, uint8_t * bytes, uint16_t length) {
|
|
// SEND_STRING("\nTX: ");
|
|
// for (uint8_t i = 0; i < length; i++) {
|
|
// send_byte(bytes[i]);
|
|
// SEND_STRING(" ");
|
|
// }
|
|
if (length > API_SYSEX_MAX_SIZE) {
|
|
xprintf("Sysex msg too big %d %d %d", message_type, data_type, length);
|
|
return;
|
|
}
|
|
|
|
|
|
// The buffer size required is calculated as the following
|
|
// API_SYSEX_MAX_SIZE is the maximum length
|
|
// In addition to that we have a two byte message header consisting of the message_type and data_type
|
|
// This has to be encoded with an additional overhead of one byte for every starting 7 bytes
|
|
// We just add one extra byte in case it's not divisible by 7
|
|
// Then we have an unencoded header consisting of 4 bytes
|
|
// Plus a one byte terminator
|
|
const unsigned message_header = 2;
|
|
const unsigned unencoded_message = API_SYSEX_MAX_SIZE + message_header;
|
|
const unsigned encoding_overhead = unencoded_message / 7 + 1;
|
|
const unsigned encoded_size = unencoded_message + encoding_overhead;
|
|
const unsigned unencoded_header = 4;
|
|
const unsigned terminator = 1;
|
|
const unsigned buffer_size = encoded_size + unencoded_header + terminator;
|
|
uint8_t buffer[encoded_size + unencoded_header + terminator];
|
|
// The unencoded header
|
|
buffer[0] = 0xF0;
|
|
buffer[1] = 0x00;
|
|
buffer[2] = 0x00;
|
|
buffer[3] = 0x00;
|
|
|
|
// We copy the message to the end of the array, this way we can do an inplace encoding, using the same
|
|
// buffer for both input and output
|
|
const unsigned message_size = length + message_header;
|
|
uint8_t* unencoded_start = buffer + buffer_size - message_size;
|
|
uint8_t* ptr = unencoded_start;
|
|
*(ptr++) = message_type;
|
|
*(ptr++) = data_type;
|
|
memcpy(ptr, bytes, length);
|
|
|
|
unsigned encoded_length = sysex_encode(buffer + unencoded_header, unencoded_start, message_size);
|
|
unsigned final_size = unencoded_header + encoded_length + terminator;
|
|
buffer[final_size - 1] = 0xF7;
|
|
midi_send_array(&midi_device, final_size, buffer);
|
|
|
|
// SEND_STRING("\nTD: ");
|
|
// for (uint8_t i = 0; i < encoded_length + 5; i++) {
|
|
// send_byte(buffer[i]);
|
|
// SEND_STRING(" ");
|
|
// }
|
|
}
|