Using new TRAINER_FRAME
This commit is contained in:
@@ -219,7 +219,7 @@ void Bluetooth::processTrainerByte(uint8_t data)
|
|||||||
crc ^= buffer[i];
|
crc ^= buffer[i];
|
||||||
}
|
}
|
||||||
if (crc == buffer[BLUETOOTH_PACKET_SIZE-1]) {
|
if (crc == buffer[BLUETOOTH_PACKET_SIZE-1]) {
|
||||||
if (buffer[0] == 0x80) {
|
if (buffer[0] == TRAINER_FRAME) {
|
||||||
processTrainerFrame(buffer);
|
processTrainerFrame(buffer);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -249,7 +249,7 @@ void Bluetooth::sendTrainer()
|
|||||||
crc = 0x00;
|
crc = 0x00;
|
||||||
|
|
||||||
buffer[bufferIndex++] = START_STOP; // start byte
|
buffer[bufferIndex++] = START_STOP; // start byte
|
||||||
pushByte(0x80); // trainer frame type?
|
pushByte(TRAINER_FRAME);
|
||||||
for (int channel=0; channel<lastCh; channel+=2, cur+=3) {
|
for (int channel=0; channel<lastCh; channel+=2, cur+=3) {
|
||||||
uint16_t channelValue1 = PPM_CH_CENTER(channel) + limit((int16_t)-PPM_range, channelOutputs[channel], (int16_t)PPM_range) / 2;
|
uint16_t channelValue1 = PPM_CH_CENTER(channel) + limit((int16_t)-PPM_range, channelOutputs[channel], (int16_t)PPM_range) / 2;
|
||||||
uint16_t channelValue2 = PPM_CH_CENTER(channel+1) + limit((int16_t)-PPM_range, channelOutputs[channel+1], (int16_t)PPM_range) / 2;
|
uint16_t channelValue2 = PPM_CH_CENTER(channel+1) + limit((int16_t)-PPM_range, channelOutputs[channel+1], (int16_t)PPM_range) / 2;
|
||||||
|
|||||||
Reference in New Issue
Block a user