RS232 control for TVOne products
spk_tvone_mbed.cpp@21:2260dde18dfa, 2013-05-12 (annotated)
- Committer:
- tobyspark
- Date:
- Sun May 12 18:36:40 2013 +0000
- Revision:
- 21:2260dde18dfa
- Parent:
- 20:ebddf3ddb1f6
- Child:
- 23:46f42462a183
Convenience methods getResolution() and getEDID()
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
tobyspark | 0:533cfae24a1b | 1 | // *spark audio-visual |
tobyspark | 0:533cfae24a1b | 2 | // RS232 Control for TV-One products |
tobyspark | 0:533cfae24a1b | 3 | // Good for 1T-C2-750, others will need some extra work |
tobyspark | 1:349d6da461df | 4 | |
tobyspark | 1:349d6da461df | 5 | /* Copyright (c) 2011 Toby Harris, MIT License |
tobyspark | 1:349d6da461df | 6 | * |
tobyspark | 1:349d6da461df | 7 | * Permission is hereby granted, free of charge, to any person obtaining a copy of this software |
tobyspark | 1:349d6da461df | 8 | * and associated documentation files (the "Software"), to deal in the Software without restriction, |
tobyspark | 1:349d6da461df | 9 | * including without limitation the rights to use, copy, modify, merge, publish, distribute, |
tobyspark | 1:349d6da461df | 10 | * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is |
tobyspark | 1:349d6da461df | 11 | * furnished to do so, subject to the following conditions: |
tobyspark | 1:349d6da461df | 12 | * |
tobyspark | 1:349d6da461df | 13 | * The above copyright notice and this permission notice shall be included in all copies or |
tobyspark | 1:349d6da461df | 14 | * substantial portions of the Software. |
tobyspark | 1:349d6da461df | 15 | * |
tobyspark | 1:349d6da461df | 16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING |
tobyspark | 1:349d6da461df | 17 | * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
tobyspark | 1:349d6da461df | 18 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, |
tobyspark | 1:349d6da461df | 19 | * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
tobyspark | 1:349d6da461df | 20 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
tobyspark | 1:349d6da461df | 21 | */ |
tobyspark | 0:533cfae24a1b | 22 | |
tobyspark | 0:533cfae24a1b | 23 | #include "spk_tvone_mbed.h" |
tobyspark | 0:533cfae24a1b | 24 | #include "mbed.h" |
tobyspark | 0:533cfae24a1b | 25 | |
tobyspark | 0:533cfae24a1b | 26 | SPKTVOne::SPKTVOne(PinName txPin, PinName rxPin, PinName signWritePin, PinName signErrorPin, Serial *debugSerial) |
tobyspark | 0:533cfae24a1b | 27 | { |
tobyspark | 0:533cfae24a1b | 28 | // Create Serial connection for TVOne unit comms |
tobyspark | 0:533cfae24a1b | 29 | // Creating our own as this is exclusively for TVOne comms |
tobyspark | 9:42c83cac2f6d | 30 | serial = new Serial(txPin, rxPin); |
tobyspark | 0:533cfae24a1b | 31 | serial->baud(57600); |
tobyspark | 0:533cfae24a1b | 32 | |
tobyspark | 0:533cfae24a1b | 33 | if (signWritePin != NC) writeDO = new DigitalOut(signWritePin); |
tobyspark | 0:533cfae24a1b | 34 | else writeDO = NULL; |
tobyspark | 0:533cfae24a1b | 35 | |
tobyspark | 0:533cfae24a1b | 36 | if (signErrorPin != NC) errorDO = new DigitalOut(signErrorPin); |
tobyspark | 0:533cfae24a1b | 37 | else errorDO = NULL; |
tobyspark | 0:533cfae24a1b | 38 | |
tobyspark | 18:d765b0d9271c | 39 | processor.version = -1; |
tobyspark | 18:d765b0d9271c | 40 | processor.productType = -1; |
tobyspark | 18:d765b0d9271c | 41 | processor.boardType = -1; |
tobyspark | 18:d765b0d9271c | 42 | |
tobyspark | 18:d765b0d9271c | 43 | resetCommandPeriods(); |
tobyspark | 14:da403a01f9ef | 44 | |
tobyspark | 14:da403a01f9ef | 45 | timer.start(); |
tobyspark | 17:68b9bb89da2b | 46 | timerCheckTicker.attach(this, &SPKTVOne::timerCheck, 60); |
tobyspark | 14:da403a01f9ef | 47 | |
tobyspark | 0:533cfae24a1b | 48 | // Link up debug Serial object |
tobyspark | 0:533cfae24a1b | 49 | // Passing in shared object as debugging is shared between all DVI mixer functions |
tobyspark | 0:533cfae24a1b | 50 | debug = debugSerial; |
tobyspark | 0:533cfae24a1b | 51 | } |
tobyspark | 0:533cfae24a1b | 52 | |
tobyspark | 10:5f398fc9b5c1 | 53 | bool SPKTVOne::command(uint8_t channel, uint8_t window, int32_t func, int32_t payload) |
tobyspark | 10:5f398fc9b5c1 | 54 | { |
tobyspark | 14:da403a01f9ef | 55 | int ackBuff[standardAckLength] = {0}; |
tobyspark | 10:5f398fc9b5c1 | 56 | |
tobyspark | 11:90e5a72a0034 | 57 | bool success = command(writeCommandType, ackBuff, standardAckLength, channel, window, func, payload); |
tobyspark | 11:90e5a72a0034 | 58 | |
tobyspark | 11:90e5a72a0034 | 59 | // TASK: Check return payload is what we tried to set it to |
tobyspark | 11:90e5a72a0034 | 60 | char payloadStr[7]; |
tobyspark | 11:90e5a72a0034 | 61 | for (int i = 0; i < 6; i++) |
tobyspark | 11:90e5a72a0034 | 62 | { |
tobyspark | 11:90e5a72a0034 | 63 | payloadStr[i] = ackBuff[11+i]; |
tobyspark | 11:90e5a72a0034 | 64 | } |
tobyspark | 11:90e5a72a0034 | 65 | payloadStr[6] = NULL; |
tobyspark | 11:90e5a72a0034 | 66 | |
tobyspark | 11:90e5a72a0034 | 67 | int payloadBack = strtol (payloadStr, NULL, 16); |
tobyspark | 11:90e5a72a0034 | 68 | |
tobyspark | 11:90e5a72a0034 | 69 | if (payload != payloadBack) |
tobyspark | 11:90e5a72a0034 | 70 | { |
tobyspark | 11:90e5a72a0034 | 71 | success = false; |
tobyspark | 13:4d659b89a457 | 72 | if (debug) debug->printf("TVOne return value (%d) is not what was set (%d). Channel: %#x, Window: %#x, Function: %#x \r\n", payloadBack, payload, channel, window, func); |
tobyspark | 11:90e5a72a0034 | 73 | } |
tobyspark | 11:90e5a72a0034 | 74 | return success; |
tobyspark | 11:90e5a72a0034 | 75 | } |
tobyspark | 11:90e5a72a0034 | 76 | |
tobyspark | 11:90e5a72a0034 | 77 | bool SPKTVOne::readCommand(uint8_t channel, uint8_t window, int32_t func, int32_t &payload) |
tobyspark | 11:90e5a72a0034 | 78 | { |
tobyspark | 14:da403a01f9ef | 79 | int ackBuff[standardAckLength] = {0}; |
tobyspark | 11:90e5a72a0034 | 80 | |
tobyspark | 11:90e5a72a0034 | 81 | bool success = command(readCommandType, ackBuff, standardAckLength, channel, window, func, payload); |
tobyspark | 11:90e5a72a0034 | 82 | |
tobyspark | 19:350d1191e466 | 83 | if (success) |
tobyspark | 19:350d1191e466 | 84 | { |
tobyspark | 19:350d1191e466 | 85 | char payloadStr[7]; |
tobyspark | 19:350d1191e466 | 86 | for (int i = 0; i < 6; i++) |
tobyspark | 19:350d1191e466 | 87 | { |
tobyspark | 19:350d1191e466 | 88 | payloadStr[i] = ackBuff[11+i]; |
tobyspark | 19:350d1191e466 | 89 | } |
tobyspark | 19:350d1191e466 | 90 | payloadStr[6] = NULL; |
tobyspark | 19:350d1191e466 | 91 | |
tobyspark | 19:350d1191e466 | 92 | payload = strtol (payloadStr, NULL, 16); |
tobyspark | 11:90e5a72a0034 | 93 | } |
tobyspark | 10:5f398fc9b5c1 | 94 | |
tobyspark | 10:5f398fc9b5c1 | 95 | return success; |
tobyspark | 10:5f398fc9b5c1 | 96 | } |
tobyspark | 10:5f398fc9b5c1 | 97 | |
tobyspark | 10:5f398fc9b5c1 | 98 | bool SPKTVOne::command(commandType readWrite, int* ackBuffer, int ackLength, uint8_t channel, uint8_t window, int32_t func, int32_t payload) |
tobyspark | 14:da403a01f9ef | 99 | { |
tobyspark | 14:da403a01f9ef | 100 | if (debug) debug->printf("TVOne %s Channel: %#x, Window: %#x, Function: %#x Payload: %i \r\n", (readWrite == writeCommandType) ? "Write" : "Read", channel, window, func, payload); |
tobyspark | 14:da403a01f9ef | 101 | |
tobyspark | 0:533cfae24a1b | 102 | // TASK: Sign start of serial command write |
tobyspark | 0:533cfae24a1b | 103 | if (writeDO) *writeDO = 1; |
tobyspark | 0:533cfae24a1b | 104 | |
tobyspark | 14:da403a01f9ef | 105 | // TASK: Prepare to issue command to the TVOne unit |
tobyspark | 14:da403a01f9ef | 106 | // - discard anything waiting to be read in the return serial buffer |
tobyspark | 14:da403a01f9ef | 107 | // - make sure we're past the minimum time between command sends as the unit can get overloaded |
tobyspark | 18:d765b0d9271c | 108 | while (serial->readable() || timer.read_ms() < commandMinimumPeriod) { |
tobyspark | 14:da403a01f9ef | 109 | if (serial->readable()) serial->getc(); |
tobyspark | 0:533cfae24a1b | 110 | } |
tobyspark | 0:533cfae24a1b | 111 | |
tobyspark | 0:533cfae24a1b | 112 | // TASK: Create the bytes of command |
tobyspark | 0:533cfae24a1b | 113 | |
tobyspark | 0:533cfae24a1b | 114 | uint8_t cmd[8]; |
tobyspark | 0:533cfae24a1b | 115 | uint8_t checksum = 0; |
tobyspark | 0:533cfae24a1b | 116 | |
tobyspark | 0:533cfae24a1b | 117 | // CMD |
tobyspark | 10:5f398fc9b5c1 | 118 | cmd[0] = readWrite<<7 | 1<<2; |
tobyspark | 0:533cfae24a1b | 119 | // CHA |
tobyspark | 0:533cfae24a1b | 120 | cmd[1] = channel; |
tobyspark | 0:533cfae24a1b | 121 | // WINDOW |
tobyspark | 0:533cfae24a1b | 122 | cmd[2] = window; |
tobyspark | 0:533cfae24a1b | 123 | // OUTPUT & FUNCTION |
tobyspark | 0:533cfae24a1b | 124 | // cmd[3] cmd[4] |
tobyspark | 0:533cfae24a1b | 125 | // output 0 = 0000xxx xxxxxxx |
tobyspark | 0:533cfae24a1b | 126 | // function = xxxXXXX XXXXXXX |
tobyspark | 0:533cfae24a1b | 127 | cmd[3] = func >> 8; |
tobyspark | 0:533cfae24a1b | 128 | cmd[4] = func & 0xFF; |
tobyspark | 0:533cfae24a1b | 129 | // PAYLOAD |
tobyspark | 0:533cfae24a1b | 130 | cmd[5] = (payload >> 16) & 0xFF; |
tobyspark | 0:533cfae24a1b | 131 | cmd[6] = (payload >> 8) & 0xFF; |
tobyspark | 0:533cfae24a1b | 132 | cmd[7] = payload & 0xFF; |
tobyspark | 0:533cfae24a1b | 133 | |
tobyspark | 0:533cfae24a1b | 134 | // TASK: Write the bytes of command to RS232 as correctly packaged 20 characters of ASCII |
tobyspark | 10:5f398fc9b5c1 | 135 | |
tobyspark | 11:90e5a72a0034 | 136 | if (readWrite == writeCommandType) |
tobyspark | 0:533cfae24a1b | 137 | { |
tobyspark | 14:da403a01f9ef | 138 | for (int i=0; i<8; i++) checksum += cmd[i]; |
tobyspark | 10:5f398fc9b5c1 | 139 | serial->printf("F%02X%02X%02X%02X%02X%02X%02X%02X%02X\r", cmd[0], cmd[1], cmd[2], cmd[3], cmd[4], cmd[5], cmd[6], cmd[7], checksum); |
tobyspark | 0:533cfae24a1b | 140 | } |
tobyspark | 11:90e5a72a0034 | 141 | if (readWrite == readCommandType) |
tobyspark | 10:5f398fc9b5c1 | 142 | { |
tobyspark | 14:da403a01f9ef | 143 | for (int i=0; i<5; i++) checksum += cmd[i]; |
tobyspark | 10:5f398fc9b5c1 | 144 | serial->printf("F%02X%02X%02X%02X%02X%02X\r", cmd[0], cmd[1], cmd[2], cmd[3], cmd[4], checksum); |
tobyspark | 10:5f398fc9b5c1 | 145 | } |
tobyspark | 10:5f398fc9b5c1 | 146 | |
tobyspark | 0:533cfae24a1b | 147 | // TASK: Check the unit's return string, to enable return to main program as soon as unit is ready |
tobyspark | 0:533cfae24a1b | 148 | |
tobyspark | 0:533cfae24a1b | 149 | // Handling the timing of this return is critical to effective control. |
tobyspark | 0:533cfae24a1b | 150 | // Returning the instant something is received back overloads the processor, as does anything until the full 20 char acknowledgement. |
tobyspark | 0:533cfae24a1b | 151 | // TVOne turn out to say that receipt of the ack doesn't guarantee the unit is ready for the next command. |
tobyspark | 0:533cfae24a1b | 152 | // According to the manual, operations typically take 30ms, and to simplify programming you can throttle commands to every 100ms. |
tobyspark | 0:533cfae24a1b | 153 | // 100ms is too slow for us. Going with returning after 30ms if we've received an acknowledgement, returning after 100ms otherwise. |
tobyspark | 10:5f398fc9b5c1 | 154 | |
tobyspark | 14:da403a01f9ef | 155 | bool success = false; |
tobyspark | 14:da403a01f9ef | 156 | int ackPos = 0; |
tobyspark | 14:da403a01f9ef | 157 | timer.reset(); |
tobyspark | 0:533cfae24a1b | 158 | |
tobyspark | 18:d765b0d9271c | 159 | while (timer.read_ms() < commandTimeoutPeriod) |
tobyspark | 10:5f398fc9b5c1 | 160 | { |
tobyspark | 14:da403a01f9ef | 161 | if (serial->readable()) |
tobyspark | 10:5f398fc9b5c1 | 162 | { |
tobyspark | 14:da403a01f9ef | 163 | if (ackPos == 0) |
tobyspark | 9:42c83cac2f6d | 164 | { |
tobyspark | 14:da403a01f9ef | 165 | ackBuffer[0] = serial->getc(); |
tobyspark | 14:da403a01f9ef | 166 | if (ackBuffer[0] == 'F') ackPos = 1; |
tobyspark | 14:da403a01f9ef | 167 | } |
tobyspark | 14:da403a01f9ef | 168 | else |
tobyspark | 14:da403a01f9ef | 169 | { |
tobyspark | 14:da403a01f9ef | 170 | ackBuffer[ackPos] = serial->getc(); |
tobyspark | 14:da403a01f9ef | 171 | ackPos++; |
tobyspark | 14:da403a01f9ef | 172 | if (ackPos == ackLength) break; |
tobyspark | 0:533cfae24a1b | 173 | } |
tobyspark | 10:5f398fc9b5c1 | 174 | } |
tobyspark | 9:42c83cac2f6d | 175 | } |
tobyspark | 20:ebddf3ddb1f6 | 176 | |
tobyspark | 14:da403a01f9ef | 177 | // Return true if we got the no error acknowledgement from the unit. The rest of the ack will be verified elsewhere if needed. |
tobyspark | 19:350d1191e466 | 178 | if (ackPos == ackLength && ackBuffer[1] == '4') |
tobyspark | 14:da403a01f9ef | 179 | { |
tobyspark | 14:da403a01f9ef | 180 | success = true; |
tobyspark | 14:da403a01f9ef | 181 | } |
tobyspark | 0:533cfae24a1b | 182 | |
tobyspark | 0:533cfae24a1b | 183 | // TASK: Sign end of write |
tobyspark | 0:533cfae24a1b | 184 | |
tobyspark | 0:533cfae24a1b | 185 | if (writeDO) *writeDO = 0; |
tobyspark | 0:533cfae24a1b | 186 | |
tobyspark | 0:533cfae24a1b | 187 | if (!success) { |
tobyspark | 0:533cfae24a1b | 188 | if (errorDO) { |
tobyspark | 0:533cfae24a1b | 189 | signErrorTimeout.detach(); |
tobyspark | 0:533cfae24a1b | 190 | signErrorTimeout.attach(this, &SPKTVOne::signErrorOff, 0.25); |
tobyspark | 0:533cfae24a1b | 191 | *errorDO = 1; |
tobyspark | 0:533cfae24a1b | 192 | } |
tobyspark | 0:533cfae24a1b | 193 | |
tobyspark | 0:533cfae24a1b | 194 | if (debug) { |
tobyspark | 14:da403a01f9ef | 195 | debug->printf("TVOne serial error. Time from finishing writing command: %ims. Received %i ack chars:", timer.read_ms(), ackPos); |
tobyspark | 14:da403a01f9ef | 196 | for (int i = 0; i<ackLength; i++) |
tobyspark | 14:da403a01f9ef | 197 | { |
tobyspark | 14:da403a01f9ef | 198 | debug->printf("%c", ackBuffer[i]); |
tobyspark | 14:da403a01f9ef | 199 | } |
tobyspark | 14:da403a01f9ef | 200 | debug->printf("\r\n"); |
tobyspark | 0:533cfae24a1b | 201 | } |
tobyspark | 0:533cfae24a1b | 202 | }; |
tobyspark | 0:533cfae24a1b | 203 | |
tobyspark | 0:533cfae24a1b | 204 | return success; |
tobyspark | 0:533cfae24a1b | 205 | } |
tobyspark | 0:533cfae24a1b | 206 | |
tobyspark | 18:d765b0d9271c | 207 | void SPKTVOne::setCommandTimeoutPeriod(int millis) |
tobyspark | 18:d765b0d9271c | 208 | { |
tobyspark | 18:d765b0d9271c | 209 | commandTimeoutPeriod = millis; |
tobyspark | 18:d765b0d9271c | 210 | } |
tobyspark | 18:d765b0d9271c | 211 | |
tobyspark | 18:d765b0d9271c | 212 | void SPKTVOne::setCommandMinimumPeriod(int millis) |
tobyspark | 18:d765b0d9271c | 213 | { |
tobyspark | 18:d765b0d9271c | 214 | commandMinimumPeriod = millis; |
tobyspark | 18:d765b0d9271c | 215 | } |
tobyspark | 18:d765b0d9271c | 216 | |
tobyspark | 18:d765b0d9271c | 217 | void SPKTVOne::increaseCommandPeriods(int millis) |
tobyspark | 18:d765b0d9271c | 218 | { |
tobyspark | 18:d765b0d9271c | 219 | commandTimeoutPeriod += millis; |
tobyspark | 18:d765b0d9271c | 220 | commandMinimumPeriod += millis; |
tobyspark | 18:d765b0d9271c | 221 | |
tobyspark | 18:d765b0d9271c | 222 | if (debug) debug->printf("Command periods increased; minimum: %i, timeout: %i", commandMinimumPeriod, commandTimeoutPeriod); |
tobyspark | 18:d765b0d9271c | 223 | } |
tobyspark | 18:d765b0d9271c | 224 | |
tobyspark | 18:d765b0d9271c | 225 | void SPKTVOne::resetCommandPeriods() |
tobyspark | 18:d765b0d9271c | 226 | { |
tobyspark | 18:d765b0d9271c | 227 | commandTimeoutPeriod = kTV1CommandTimeoutMillis; |
tobyspark | 18:d765b0d9271c | 228 | commandMinimumPeriod = kTV1CommandMinimumMillis; |
tobyspark | 18:d765b0d9271c | 229 | } |
tobyspark | 18:d765b0d9271c | 230 | |
tobyspark | 20:ebddf3ddb1f6 | 231 | int SPKTVOne::getCommandTimeoutPeriod() |
tobyspark | 20:ebddf3ddb1f6 | 232 | { |
tobyspark | 20:ebddf3ddb1f6 | 233 | return commandTimeoutPeriod; |
tobyspark | 20:ebddf3ddb1f6 | 234 | } |
tobyspark | 20:ebddf3ddb1f6 | 235 | |
tobyspark | 20:ebddf3ddb1f6 | 236 | int SPKTVOne::millisSinceLastCommandSent() |
tobyspark | 14:da403a01f9ef | 237 | { |
tobyspark | 14:da403a01f9ef | 238 | return timer.read_ms(); |
tobyspark | 14:da403a01f9ef | 239 | } |
tobyspark | 14:da403a01f9ef | 240 | |
tobyspark | 18:d765b0d9271c | 241 | bool SPKTVOne::uploadCustomResolutions() |
tobyspark | 0:533cfae24a1b | 242 | { |
tobyspark | 11:90e5a72a0034 | 243 | bool ok = true;; |
tobyspark | 11:90e5a72a0034 | 244 | int unlocked = 0; |
tobyspark | 11:90e5a72a0034 | 245 | int locked = 1; |
tobyspark | 11:90e5a72a0034 | 246 | |
tobyspark | 11:90e5a72a0034 | 247 | ok = ok && command(0, 0, kTV1FunctionAdjustFrontPanelLock, locked); |
tobyspark | 11:90e5a72a0034 | 248 | |
tobyspark | 11:90e5a72a0034 | 249 | ok = ok && set1920x480(kTV1ResolutionTripleHeadVGAp60); |
tobyspark | 11:90e5a72a0034 | 250 | ok = ok && set1600x600(kTV1ResolutionDualHeadSVGAp60); |
tobyspark | 11:90e5a72a0034 | 251 | ok = ok && set2048x768(kTV1ResolutionDualHeadXGAp60); |
tobyspark | 11:90e5a72a0034 | 252 | |
tobyspark | 11:90e5a72a0034 | 253 | ok = ok && command(0, 0, kTV1FunctionAdjustFrontPanelLock, unlocked); |
tobyspark | 11:90e5a72a0034 | 254 | |
tobyspark | 11:90e5a72a0034 | 255 | return ok; |
tobyspark | 0:533cfae24a1b | 256 | } |
tobyspark | 0:533cfae24a1b | 257 | |
tobyspark | 21:2260dde18dfa | 258 | int SPKTVOne::getEDID() |
tobyspark | 21:2260dde18dfa | 259 | { |
tobyspark | 21:2260dde18dfa | 260 | bool ok = true; |
tobyspark | 21:2260dde18dfa | 261 | |
tobyspark | 21:2260dde18dfa | 262 | int32_t payload1 = -1; |
tobyspark | 21:2260dde18dfa | 263 | ok = ok && readCommand(kTV1SourceRGB1, kTV1WindowIDA, kTV1FunctionAdjustSourceEDID, payload1); |
tobyspark | 21:2260dde18dfa | 264 | |
tobyspark | 21:2260dde18dfa | 265 | int32_t payload2 = -1; |
tobyspark | 21:2260dde18dfa | 266 | ok = ok && readCommand(kTV1SourceRGB2, kTV1WindowIDA, kTV1FunctionAdjustSourceEDID, payload2); |
tobyspark | 21:2260dde18dfa | 267 | |
tobyspark | 21:2260dde18dfa | 268 | int EDID = (payload1 == payload2) ? payload1 : -1; |
tobyspark | 21:2260dde18dfa | 269 | |
tobyspark | 21:2260dde18dfa | 270 | return ok ? EDID : -1; |
tobyspark | 21:2260dde18dfa | 271 | } |
tobyspark | 21:2260dde18dfa | 272 | |
tobyspark | 21:2260dde18dfa | 273 | int SPKTVOne::getResolution() |
tobyspark | 21:2260dde18dfa | 274 | { |
tobyspark | 21:2260dde18dfa | 275 | bool ok; |
tobyspark | 21:2260dde18dfa | 276 | |
tobyspark | 21:2260dde18dfa | 277 | int32_t payload = -1; |
tobyspark | 21:2260dde18dfa | 278 | ok = readCommand(0, kTV1WindowIDA, kTV1FunctionAdjustOutputsOutputResolution, payload); |
tobyspark | 21:2260dde18dfa | 279 | |
tobyspark | 21:2260dde18dfa | 280 | return ok ? payload : -1; |
tobyspark | 21:2260dde18dfa | 281 | } |
tobyspark | 21:2260dde18dfa | 282 | |
tobyspark | 18:d765b0d9271c | 283 | bool SPKTVOne::setResolution(int resolution, int edidSlot) |
tobyspark | 18:d765b0d9271c | 284 | { |
tobyspark | 18:d765b0d9271c | 285 | bool ok; |
tobyspark | 18:d765b0d9271c | 286 | |
tobyspark | 18:d765b0d9271c | 287 | int minPeriodOnEntry = commandMinimumPeriod; |
tobyspark | 18:d765b0d9271c | 288 | int outPeriodOnEntry = commandTimeoutPeriod; |
tobyspark | 18:d765b0d9271c | 289 | |
tobyspark | 18:d765b0d9271c | 290 | for (int i=0; i < 3; i++) |
tobyspark | 18:d765b0d9271c | 291 | { |
tobyspark | 18:d765b0d9271c | 292 | ok = command(0, kTV1WindowIDA, kTV1FunctionAdjustOutputsOutputResolution, resolution); |
tobyspark | 18:d765b0d9271c | 293 | |
tobyspark | 18:d765b0d9271c | 294 | if (ok) break; |
tobyspark | 18:d765b0d9271c | 295 | else increaseCommandPeriods(500); |
tobyspark | 18:d765b0d9271c | 296 | } |
tobyspark | 18:d765b0d9271c | 297 | commandMinimumPeriod = minPeriodOnEntry; |
tobyspark | 18:d765b0d9271c | 298 | commandTimeoutPeriod = outPeriodOnEntry; |
tobyspark | 18:d765b0d9271c | 299 | if (!ok) return ok; |
tobyspark | 18:d765b0d9271c | 300 | |
tobyspark | 18:d765b0d9271c | 301 | for (int i=0; i < 3; i++) |
tobyspark | 18:d765b0d9271c | 302 | { |
tobyspark | 18:d765b0d9271c | 303 | ok = command(kTV1SourceRGB1, kTV1WindowIDA, kTV1FunctionAdjustSourceEDID, edidSlot); |
tobyspark | 18:d765b0d9271c | 304 | ok = ok && command(kTV1SourceRGB2, kTV1WindowIDA, kTV1FunctionAdjustSourceEDID, edidSlot); |
tobyspark | 18:d765b0d9271c | 305 | |
tobyspark | 18:d765b0d9271c | 306 | if (ok) break; |
tobyspark | 18:d765b0d9271c | 307 | else increaseCommandPeriods(500); |
tobyspark | 18:d765b0d9271c | 308 | } |
tobyspark | 18:d765b0d9271c | 309 | commandMinimumPeriod = minPeriodOnEntry; |
tobyspark | 18:d765b0d9271c | 310 | commandTimeoutPeriod = outPeriodOnEntry; |
tobyspark | 18:d765b0d9271c | 311 | |
tobyspark | 18:d765b0d9271c | 312 | return ok; |
tobyspark | 18:d765b0d9271c | 313 | } |
tobyspark | 18:d765b0d9271c | 314 | |
tobyspark | 3:03e7e7b7a870 | 315 | bool SPKTVOne::setHDCPOn(bool state) |
tobyspark | 0:533cfae24a1b | 316 | { |
tobyspark | 18:d765b0d9271c | 317 | bool ok; |
tobyspark | 18:d765b0d9271c | 318 | |
tobyspark | 18:d765b0d9271c | 319 | int minPeriodOnEntry = commandMinimumPeriod; |
tobyspark | 18:d765b0d9271c | 320 | int outPeriodOnEntry = commandTimeoutPeriod; |
tobyspark | 18:d765b0d9271c | 321 | |
tobyspark | 18:d765b0d9271c | 322 | // HDCP can sometimes take a little time to settle down |
tobyspark | 18:d765b0d9271c | 323 | for (int i=0; i < 3; i++) |
tobyspark | 18:d765b0d9271c | 324 | { |
tobyspark | 18:d765b0d9271c | 325 | // Turn HDCP off on the output |
tobyspark | 18:d765b0d9271c | 326 | ok = command(0, kTV1WindowIDA, kTV1FunctionAdjustOutputsHDCPRequired, state); |
tobyspark | 18:d765b0d9271c | 327 | |
tobyspark | 18:d765b0d9271c | 328 | // Likewise on inputs A and B |
tobyspark | 18:d765b0d9271c | 329 | ok = ok && command(kTV1SourceRGB1, kTV1WindowIDA, kTV1FunctionAdjustSourceHDCPAdvertize, state); |
tobyspark | 18:d765b0d9271c | 330 | ok = ok && command(kTV1SourceRGB2, kTV1WindowIDA, kTV1FunctionAdjustSourceHDCPAdvertize, state); |
tobyspark | 19:350d1191e466 | 331 | |
tobyspark | 19:350d1191e466 | 332 | // This verify code is accurate but too misleading for D-Fuser use - eg. actual HDCP state requires source / output connection. |
tobyspark | 19:350d1191e466 | 333 | // // Now verify whats actually going on. |
tobyspark | 19:350d1191e466 | 334 | // int32_t payload = -1; |
tobyspark | 19:350d1191e466 | 335 | // ok = ok && readCommand(0, kTV1WindowIDA, kTV1FunctionAdjustOutputsHDCPStatus, payload); |
tobyspark | 19:350d1191e466 | 336 | // switch (payload) |
tobyspark | 19:350d1191e466 | 337 | // { |
tobyspark | 19:350d1191e466 | 338 | // case 0: ok = ok && !state; break; |
tobyspark | 19:350d1191e466 | 339 | // case 1: ok = ok && !state; break; |
tobyspark | 19:350d1191e466 | 340 | // case 2: ok = ok && state; break; |
tobyspark | 19:350d1191e466 | 341 | // case 3: ok = ok && !state; break; |
tobyspark | 19:350d1191e466 | 342 | // case 4: ok = ok && state; break; |
tobyspark | 19:350d1191e466 | 343 | // default: ok = false; |
tobyspark | 19:350d1191e466 | 344 | // } |
tobyspark | 19:350d1191e466 | 345 | // |
tobyspark | 19:350d1191e466 | 346 | // payload = -1; |
tobyspark | 19:350d1191e466 | 347 | // ok = ok && readCommand(kTV1SourceRGB1, kTV1WindowIDA, kTV1FunctionAdjustSourceHDCPStatus, payload); |
tobyspark | 19:350d1191e466 | 348 | // ok = ok && (payload == state); |
tobyspark | 19:350d1191e466 | 349 | // |
tobyspark | 19:350d1191e466 | 350 | // payload = -1; |
tobyspark | 19:350d1191e466 | 351 | // ok = ok && readCommand(kTV1SourceRGB2, kTV1WindowIDA, kTV1FunctionAdjustSourceHDCPStatus, payload); |
tobyspark | 19:350d1191e466 | 352 | // ok = ok && (payload == state); |
tobyspark | 18:d765b0d9271c | 353 | |
tobyspark | 18:d765b0d9271c | 354 | if (ok) break; |
tobyspark | 18:d765b0d9271c | 355 | else increaseCommandPeriods(500); |
tobyspark | 18:d765b0d9271c | 356 | } |
tobyspark | 18:d765b0d9271c | 357 | commandMinimumPeriod = minPeriodOnEntry; |
tobyspark | 18:d765b0d9271c | 358 | commandTimeoutPeriod = outPeriodOnEntry; |
tobyspark | 0:533cfae24a1b | 359 | |
tobyspark | 18:d765b0d9271c | 360 | return ok; |
tobyspark | 0:533cfae24a1b | 361 | } |
tobyspark | 0:533cfae24a1b | 362 | |
tobyspark | 11:90e5a72a0034 | 363 | bool SPKTVOne::set1920x480(int resStoreNumber) |
tobyspark | 0:533cfae24a1b | 364 | { |
tobyspark | 11:90e5a72a0034 | 365 | bool ok; |
tobyspark | 11:90e5a72a0034 | 366 | |
tobyspark | 11:90e5a72a0034 | 367 | ok = command(0, 0, kTV1FunctionAdjustResolutionImageToAdjust, resStoreNumber); |
tobyspark | 18:d765b0d9271c | 368 | |
tobyspark | 18:d765b0d9271c | 369 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionInterlaced, 0); |
tobyspark | 18:d765b0d9271c | 370 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionFreqCoarseH, 31475); |
tobyspark | 18:d765b0d9271c | 371 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionFreqFineH, 31475); |
tobyspark | 18:d765b0d9271c | 372 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionActiveH, 1920); |
tobyspark | 18:d765b0d9271c | 373 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionActiveV, 480); |
tobyspark | 18:d765b0d9271c | 374 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionStartH, 240); |
tobyspark | 18:d765b0d9271c | 375 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionStartV, 5); |
tobyspark | 18:d765b0d9271c | 376 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionCLKS, 2400); |
tobyspark | 18:d765b0d9271c | 377 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionLines, 525); |
tobyspark | 18:d765b0d9271c | 378 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionSyncH, 192); |
tobyspark | 18:d765b0d9271c | 379 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionSyncV, 30); |
tobyspark | 18:d765b0d9271c | 380 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionSyncPolarity, 0); |
tobyspark | 11:90e5a72a0034 | 381 | |
tobyspark | 11:90e5a72a0034 | 382 | return ok; |
tobyspark | 0:533cfae24a1b | 383 | } |
tobyspark | 0:533cfae24a1b | 384 | |
tobyspark | 11:90e5a72a0034 | 385 | bool SPKTVOne::set1600x600(int resStoreNumber) |
tobyspark | 0:533cfae24a1b | 386 | { |
tobyspark | 11:90e5a72a0034 | 387 | bool ok; |
tobyspark | 11:90e5a72a0034 | 388 | |
tobyspark | 11:90e5a72a0034 | 389 | ok = command(0, 0, kTV1FunctionAdjustResolutionImageToAdjust, resStoreNumber); |
tobyspark | 18:d765b0d9271c | 390 | |
tobyspark | 18:d765b0d9271c | 391 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionInterlaced, 0); |
tobyspark | 18:d765b0d9271c | 392 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionFreqCoarseH, 37879); |
tobyspark | 18:d765b0d9271c | 393 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionFreqFineH, 37879); |
tobyspark | 18:d765b0d9271c | 394 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionActiveH, 1600); |
tobyspark | 18:d765b0d9271c | 395 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionActiveV, 600); |
tobyspark | 18:d765b0d9271c | 396 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionStartH, 192); |
tobyspark | 18:d765b0d9271c | 397 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionStartV, 14); |
tobyspark | 18:d765b0d9271c | 398 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionCLKS, 2112); |
tobyspark | 18:d765b0d9271c | 399 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionLines, 628); |
tobyspark | 18:d765b0d9271c | 400 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionSyncH, 160); |
tobyspark | 18:d765b0d9271c | 401 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionSyncV, 13); |
tobyspark | 18:d765b0d9271c | 402 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionSyncPolarity, 0); |
tobyspark | 11:90e5a72a0034 | 403 | |
tobyspark | 11:90e5a72a0034 | 404 | return ok; |
tobyspark | 0:533cfae24a1b | 405 | } |
tobyspark | 0:533cfae24a1b | 406 | |
tobyspark | 11:90e5a72a0034 | 407 | bool SPKTVOne::set2048x768(int resStoreNumber) |
tobyspark | 2:af9e9ab63b23 | 408 | { |
tobyspark | 11:90e5a72a0034 | 409 | bool ok; |
tobyspark | 11:90e5a72a0034 | 410 | |
tobyspark | 11:90e5a72a0034 | 411 | ok = command(0, 0, kTV1FunctionAdjustResolutionImageToAdjust, resStoreNumber); |
tobyspark | 18:d765b0d9271c | 412 | |
tobyspark | 18:d765b0d9271c | 413 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionInterlaced, 0); |
tobyspark | 18:d765b0d9271c | 414 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionFreqCoarseH, 48363); |
tobyspark | 18:d765b0d9271c | 415 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionFreqFineH, 48363); |
tobyspark | 18:d765b0d9271c | 416 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionActiveH, 2048); |
tobyspark | 18:d765b0d9271c | 417 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionActiveV, 768); |
tobyspark | 18:d765b0d9271c | 418 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionStartH, 224); |
tobyspark | 18:d765b0d9271c | 419 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionStartV, 11); |
tobyspark | 18:d765b0d9271c | 420 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionCLKS, 2688); |
tobyspark | 18:d765b0d9271c | 421 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionLines, 806); |
tobyspark | 18:d765b0d9271c | 422 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionSyncH, 368); |
tobyspark | 18:d765b0d9271c | 423 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionSyncV, 24); |
tobyspark | 18:d765b0d9271c | 424 | ok = ok && command(0, 0, kTV1FunctionAdjustResolutionSyncPolarity, 0); |
tobyspark | 11:90e5a72a0034 | 425 | |
tobyspark | 11:90e5a72a0034 | 426 | return ok; |
tobyspark | 2:af9e9ab63b23 | 427 | } |
tobyspark | 2:af9e9ab63b23 | 428 | |
tobyspark | 0:533cfae24a1b | 429 | void SPKTVOne::signErrorOff() { |
tobyspark | 0:533cfae24a1b | 430 | *errorDO = 0; |
tobyspark | 0:533cfae24a1b | 431 | } |
tobyspark | 14:da403a01f9ef | 432 | |
tobyspark | 18:d765b0d9271c | 433 | SPKTVOne::processorType SPKTVOne::getProcessorType() |
tobyspark | 18:d765b0d9271c | 434 | { |
tobyspark | 18:d765b0d9271c | 435 | bool ok; |
tobyspark | 18:d765b0d9271c | 436 | int32_t payload = 0; |
tobyspark | 18:d765b0d9271c | 437 | |
tobyspark | 18:d765b0d9271c | 438 | if (processor.version == -1) |
tobyspark | 18:d765b0d9271c | 439 | { |
tobyspark | 18:d765b0d9271c | 440 | ok = readCommand(0, kTV1WindowIDA, kTV1FunctionReadSoftwareVersion, payload); |
tobyspark | 18:d765b0d9271c | 441 | if (ok && payload > 0) processor.version = payload; |
tobyspark | 18:d765b0d9271c | 442 | } |
tobyspark | 18:d765b0d9271c | 443 | |
tobyspark | 18:d765b0d9271c | 444 | if (processor.productType == -1) |
tobyspark | 18:d765b0d9271c | 445 | { |
tobyspark | 18:d765b0d9271c | 446 | ok = readCommand(0, kTV1WindowIDA, kTV1FunctionReadProductType, payload); |
tobyspark | 18:d765b0d9271c | 447 | if (ok && payload > 0) processor.productType = payload; |
tobyspark | 18:d765b0d9271c | 448 | } |
tobyspark | 18:d765b0d9271c | 449 | |
tobyspark | 18:d765b0d9271c | 450 | if (processor.boardType == -1) |
tobyspark | 18:d765b0d9271c | 451 | { |
tobyspark | 18:d765b0d9271c | 452 | ok = readCommand(0, kTV1WindowIDA, kTV1FunctionReadBoardType, payload); |
tobyspark | 18:d765b0d9271c | 453 | if (ok && payload > 0) processor.boardType = payload; |
tobyspark | 18:d765b0d9271c | 454 | } |
tobyspark | 18:d765b0d9271c | 455 | |
tobyspark | 18:d765b0d9271c | 456 | if (debug) debug->printf("v: %i, p: %i, b: %i", processor.version, processor.productType, processor.boardType); |
tobyspark | 18:d765b0d9271c | 457 | |
tobyspark | 18:d765b0d9271c | 458 | return processor; |
tobyspark | 18:d765b0d9271c | 459 | } |
tobyspark | 18:d765b0d9271c | 460 | |
tobyspark | 17:68b9bb89da2b | 461 | void SPKTVOne::timerCheck() { |
tobyspark | 17:68b9bb89da2b | 462 | // timers are based on 32-bit int microsecond counters, so can only time up to a maximum of 2^31-1 microseconds i.e. 30 minutes. |
tobyspark | 17:68b9bb89da2b | 463 | // this method is called once a minute, and resets the timer if we've been idle for 25mins. |
tobyspark | 18:d765b0d9271c | 464 | if (timer.read_ms() > 1000*60*25) |
tobyspark | 17:68b9bb89da2b | 465 | { |
tobyspark | 17:68b9bb89da2b | 466 | if (debug) debug->printf("TVOne Timer reset at %ims", timer.read_ms()); |
tobyspark | 17:68b9bb89da2b | 467 | timer.reset(); |
tobyspark | 17:68b9bb89da2b | 468 | } |
tobyspark | 17:68b9bb89da2b | 469 | } |
tobyspark | 17:68b9bb89da2b | 470 | |
tobyspark | 16:ed8d08386034 | 471 | bool SPKTVOne::uploadEDID(FILE *file, int edidSlotIndex) |
tobyspark | 14:da403a01f9ef | 472 | { |
tobyspark | 16:ed8d08386034 | 473 | bool success; |
tobyspark | 14:da403a01f9ef | 474 | |
tobyspark | 14:da403a01f9ef | 475 | // To write EDID, its broken into chunks and sent as a series of extra-long commands |
tobyspark | 14:da403a01f9ef | 476 | // Command: 8 bytes of command (see code below) + 32 bytes of EDID payload + End byte |
tobyspark | 14:da403a01f9ef | 477 | // Acknowledgement: 53 02 40 95 (Hex) |
tobyspark | 16:ed8d08386034 | 478 | // We want to upload full EDID slot, ie. zero out to 256 even if edidData is only 128bytes. |
tobyspark | 14:da403a01f9ef | 479 | |
tobyspark | 16:ed8d08386034 | 480 | if (debug) debug->printf("Upload EDID to index %i \r\n", edidSlotIndex); |
tobyspark | 16:ed8d08386034 | 481 | |
tobyspark | 16:ed8d08386034 | 482 | success = uploadFile(0x07, file, 256, edidSlotIndex); |
tobyspark | 16:ed8d08386034 | 483 | |
tobyspark | 16:ed8d08386034 | 484 | return success; |
tobyspark | 16:ed8d08386034 | 485 | } |
tobyspark | 16:ed8d08386034 | 486 | |
tobyspark | 16:ed8d08386034 | 487 | bool SPKTVOne::uploadImage(FILE *file, int sisIndex) |
tobyspark | 16:ed8d08386034 | 488 | { |
tobyspark | 16:ed8d08386034 | 489 | bool success; |
tobyspark | 16:ed8d08386034 | 490 | |
tobyspark | 16:ed8d08386034 | 491 | int imageDataLength = 0; |
tobyspark | 16:ed8d08386034 | 492 | |
tobyspark | 16:ed8d08386034 | 493 | while (fgetc(file) != EOF) imageDataLength++ ; |
tobyspark | 16:ed8d08386034 | 494 | |
tobyspark | 16:ed8d08386034 | 495 | if (debug) debug->printf("Upload Image with length %i to index %i \r\n", imageDataLength, sisIndex); |
tobyspark | 16:ed8d08386034 | 496 | |
tobyspark | 16:ed8d08386034 | 497 | success = uploadFile(0x00, file, imageDataLength, sisIndex); |
tobyspark | 16:ed8d08386034 | 498 | |
tobyspark | 16:ed8d08386034 | 499 | return success; |
tobyspark | 16:ed8d08386034 | 500 | } |
tobyspark | 16:ed8d08386034 | 501 | |
tobyspark | 16:ed8d08386034 | 502 | bool SPKTVOne::uploadFile(char instruction, FILE* file, int dataLength, int index) |
tobyspark | 16:ed8d08386034 | 503 | { |
tobyspark | 16:ed8d08386034 | 504 | // TASK: Upload Data |
tobyspark | 16:ed8d08386034 | 505 | |
tobyspark | 18:d765b0d9271c | 506 | // Lets be conservative with timings |
tobyspark | 18:d765b0d9271c | 507 | setCommandMinimumPeriod(100); |
tobyspark | 18:d765b0d9271c | 508 | setCommandTimeoutPeriod(300); |
tobyspark | 18:d765b0d9271c | 509 | |
tobyspark | 16:ed8d08386034 | 510 | // This command is reverse engineered. It implements an 'S' command, not the documented 'F'. |
tobyspark | 14:da403a01f9ef | 511 | |
tobyspark | 14:da403a01f9ef | 512 | bool success = false; |
tobyspark | 14:da403a01f9ef | 513 | |
tobyspark | 16:ed8d08386034 | 514 | int dataChunkSize = 32; |
tobyspark | 14:da403a01f9ef | 515 | int ackLength = 4; |
tobyspark | 14:da403a01f9ef | 516 | char goodAck[] = {0x53, 0x02, 0x40, 0x95}; |
tobyspark | 14:da403a01f9ef | 517 | |
tobyspark | 16:ed8d08386034 | 518 | fseek(file, 0, SEEK_SET); |
tobyspark | 16:ed8d08386034 | 519 | |
tobyspark | 16:ed8d08386034 | 520 | for (int i=0; i<dataLength; i=i+dataChunkSize) |
tobyspark | 14:da403a01f9ef | 521 | { |
tobyspark | 16:ed8d08386034 | 522 | int dataRemaining = dataLength - i; |
tobyspark | 18:d765b0d9271c | 523 | int actualDataChunkSize = (dataRemaining < dataChunkSize) ? dataRemaining : dataChunkSize; |
tobyspark | 16:ed8d08386034 | 524 | |
tobyspark | 16:ed8d08386034 | 525 | int commandLength = 8+dataChunkSize+1; |
tobyspark | 14:da403a01f9ef | 526 | char command[commandLength]; |
tobyspark | 14:da403a01f9ef | 527 | |
tobyspark | 14:da403a01f9ef | 528 | command[0] = 0x53; |
tobyspark | 18:d765b0d9271c | 529 | command[1] = 6 + actualDataChunkSize + 1; // Subsequent number of bytes in command |
tobyspark | 14:da403a01f9ef | 530 | command[2] = 0x22; |
tobyspark | 16:ed8d08386034 | 531 | command[3] = instruction; |
tobyspark | 16:ed8d08386034 | 532 | command[4] = index; |
tobyspark | 14:da403a01f9ef | 533 | command[5] = 0; |
tobyspark | 16:ed8d08386034 | 534 | command[6] = (i / dataChunkSize) & 0xFF; // chunk index LSB |
tobyspark | 16:ed8d08386034 | 535 | command[7] = ((i / dataChunkSize) >> 8) & 0xFF; // chunk index MSB |
tobyspark | 14:da403a01f9ef | 536 | |
tobyspark | 18:d765b0d9271c | 537 | for (int j=0; j<actualDataChunkSize; j++) |
tobyspark | 14:da403a01f9ef | 538 | { |
tobyspark | 16:ed8d08386034 | 539 | char data = fgetc(file); |
tobyspark | 16:ed8d08386034 | 540 | if (!feof(file)) |
tobyspark | 16:ed8d08386034 | 541 | *(command+8+j) = data; |
tobyspark | 14:da403a01f9ef | 542 | else |
tobyspark | 14:da403a01f9ef | 543 | *(command+8+j) = 0; |
tobyspark | 14:da403a01f9ef | 544 | } |
tobyspark | 14:da403a01f9ef | 545 | |
tobyspark | 18:d765b0d9271c | 546 | command[8+actualDataChunkSize] = 0x3F; |
tobyspark | 14:da403a01f9ef | 547 | |
tobyspark | 14:da403a01f9ef | 548 | if (debug) |
tobyspark | 14:da403a01f9ef | 549 | { |
tobyspark | 16:ed8d08386034 | 550 | debug->printf("Command: "); |
tobyspark | 14:da403a01f9ef | 551 | for (int k=0; k < commandLength; k++) debug->printf(" %x", command[k]); |
tobyspark | 14:da403a01f9ef | 552 | debug->printf("\r\n"); |
tobyspark | 14:da403a01f9ef | 553 | } |
tobyspark | 14:da403a01f9ef | 554 | |
tobyspark | 18:d765b0d9271c | 555 | while (serial->readable() || timer.read_ms() < commandMinimumPeriod) |
tobyspark | 14:da403a01f9ef | 556 | { |
tobyspark | 14:da403a01f9ef | 557 | if (serial->readable()) serial->getc(); |
tobyspark | 14:da403a01f9ef | 558 | } |
tobyspark | 14:da403a01f9ef | 559 | |
tobyspark | 14:da403a01f9ef | 560 | for (int k=0; k < commandLength; k++) serial->putc(command[k]); |
tobyspark | 14:da403a01f9ef | 561 | |
tobyspark | 14:da403a01f9ef | 562 | timer.reset(); |
tobyspark | 14:da403a01f9ef | 563 | |
tobyspark | 14:da403a01f9ef | 564 | char ackBuffer[4]; |
tobyspark | 14:da403a01f9ef | 565 | int ackPos = 0; |
tobyspark | 18:d765b0d9271c | 566 | while (timer.read_ms() < commandTimeoutPeriod) |
tobyspark | 14:da403a01f9ef | 567 | { |
tobyspark | 14:da403a01f9ef | 568 | if (serial->readable()) ackBuffer[ackPos++] = serial->getc(); |
tobyspark | 14:da403a01f9ef | 569 | if (ackPos == 4) break; |
tobyspark | 14:da403a01f9ef | 570 | } |
tobyspark | 16:ed8d08386034 | 571 | |
tobyspark | 14:da403a01f9ef | 572 | if (memcmp(ackBuffer, goodAck, ackLength) == 0) |
tobyspark | 14:da403a01f9ef | 573 | { |
tobyspark | 14:da403a01f9ef | 574 | success = true; |
tobyspark | 14:da403a01f9ef | 575 | } |
tobyspark | 14:da403a01f9ef | 576 | else |
tobyspark | 14:da403a01f9ef | 577 | { |
tobyspark | 14:da403a01f9ef | 578 | success = false; |
tobyspark | 14:da403a01f9ef | 579 | if (debug) |
tobyspark | 14:da403a01f9ef | 580 | { |
tobyspark | 18:d765b0d9271c | 581 | debug->printf("Data Part write failed. Ack:"); |
tobyspark | 14:da403a01f9ef | 582 | for (int k = 0; k < ackLength; k++) debug->printf(" %x", ackBuffer[k]); |
tobyspark | 14:da403a01f9ef | 583 | debug->printf("\r\n"); |
tobyspark | 14:da403a01f9ef | 584 | } |
tobyspark | 14:da403a01f9ef | 585 | break; |
tobyspark | 14:da403a01f9ef | 586 | } |
tobyspark | 14:da403a01f9ef | 587 | } |
tobyspark | 14:da403a01f9ef | 588 | |
tobyspark | 18:d765b0d9271c | 589 | resetCommandPeriods(); |
tobyspark | 18:d765b0d9271c | 590 | |
tobyspark | 14:da403a01f9ef | 591 | return success; |
tobyspark | 14:da403a01f9ef | 592 | } |