quantum/api/api_sysex.c

   1 /* Copyright 2016 Jack Humbert, Fred Sundvik
   2  *
   3  * This program is free software: you can redistribute it and/or modify
   4  * it under the terms of the GNU General Public License as published by
   5  * the Free Software Foundation, either version 2 of the License, or
   6  * (at your option) any later version.
   7  *
   8  * This program is distributed in the hope that it will be useful,
   9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  11  * GNU General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU General Public License
  14  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  15  */
  16 #include "api_sysex.h"
  17 #include "sysex_tools.h"
  18 #include "print.h"
  19 #include "qmk_midi.h"
  20
  21 void send_bytes_sysex(uint8_t message_type, uint8_t data_type, uint8_t * bytes, uint16_t length) {
  22     // SEND_STRING("\nTX: ");
  23     // for (uint8_t i = 0; i < length; i++) {
  24     //     send_byte(bytes[i]);
  25     //     SEND_STRING(" ");
  26     // }
  27     if (length > API_SYSEX_MAX_SIZE) {
  28         xprintf("Sysex msg too big %d %d %d", message_type, data_type, length);
  29         return;
  30     }
  31
  32
  33     // The buffer size required is calculated as the following
  34     // API_SYSEX_MAX_SIZE is the maximum length
  35     // In addition to that we have a two byte message header consisting of the message_type and data_type
  36     // This has to be encoded with an additional overhead of one byte for every starting 7 bytes
  37     // We just add one extra byte in case it's not divisible by 7
  38     // Then we have an unencoded header consisting of 4 bytes
  39     // Plus a one byte terminator
  40     const unsigned message_header = 2;
  41     const unsigned unencoded_message = API_SYSEX_MAX_SIZE + message_header;
  42     const unsigned encoding_overhead = unencoded_message / 7 + 1;
  43     const unsigned encoded_size = unencoded_message + encoding_overhead;
  44     const unsigned unencoded_header = 4;
  45     const unsigned terminator = 1;
  46     const unsigned buffer_size = encoded_size + unencoded_header + terminator;
  47     uint8_t buffer[encoded_size + unencoded_header + terminator];
  48     // The unencoded header
  49     buffer[0] = 0xF0;
  50     buffer[1] = 0x00;
  51     buffer[2] = 0x00;
  52     buffer[3] = 0x00;
  53
  54     // We copy the message to the end of the array, this way we can do an inplace encoding, using the same
  55     // buffer for both input and output
  56     const unsigned message_size = length + message_header;
  57     uint8_t* unencoded_start = buffer + buffer_size - message_size;
  58     uint8_t* ptr = unencoded_start;
  59     *(ptr++) = message_type;
  60     *(ptr++) = data_type;
  61     memcpy(ptr, bytes, length);
  62
  63     unsigned encoded_length = sysex_encode(buffer + unencoded_header, unencoded_start, message_size);
  64     unsigned final_size = unencoded_header + encoded_length + terminator;
  65     buffer[final_size - 1] = 0xF7;
  66     midi_send_array(&midi_device, final_size, buffer);
  67
  68     // SEND_STRING("\nTD: ");
  69     // for (uint8_t i = 0; i < encoded_length + 5; i++) {
  70     //     send_byte(buffer[i]);
  71     //     SEND_STRING(" ");
  72     // }
  73 }