Desktop Station gateway software for mbed
Dependents: DSGatewayMBED_Nucleo DSGatewayMBED_Nucleo_Step128
This library provides to control DCC and Marklin Motorola 2 locomtoives and turnouts via DCC/MM2 Shield. Please check our wiki site(http://desktopstation.net/wiki/).
DSGatewayMBED.cpp@1:39249e22e9f5, 2015-01-23 (annotated)
- Committer:
- yaasan
- Date:
- Fri Jan 23 22:28:51 2015 +0000
- Revision:
- 1:39249e22e9f5
- Parent:
- 0:96eb8cc345dc
Worked first version
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
yaasan | 1:39249e22e9f5 | 1 | /********************************************************************* |
yaasan | 1:39249e22e9f5 | 2 | * Desktop Station Gateway Library for mbed platform |
yaasan | 1:39249e22e9f5 | 3 | * |
yaasan | 1:39249e22e9f5 | 4 | * Copyright (C) 2015 Yaasan |
yaasan | 1:39249e22e9f5 | 5 | * |
yaasan | 1:39249e22e9f5 | 6 | */ |
yaasan | 1:39249e22e9f5 | 7 | |
yaasan | 0:96eb8cc345dc | 8 | #include "DSGatewayMBED.h" |
yaasan | 0:96eb8cc345dc | 9 | #include "mbed.h" |
yaasan | 0:96eb8cc345dc | 10 | |
yaasan | 0:96eb8cc345dc | 11 | SPI spiDS(SPI_MOSI, SPI_MISO, SPI_SCK); |
yaasan | 1:39249e22e9f5 | 12 | DigitalOut cs(PB_6); |
yaasan | 0:96eb8cc345dc | 13 | |
yaasan | 0:96eb8cc345dc | 14 | DSGatewayLib::DSGatewayLib() |
yaasan | 0:96eb8cc345dc | 15 | { |
yaasan | 0:96eb8cc345dc | 16 | |
yaasan | 0:96eb8cc345dc | 17 | poweron = false; |
yaasan | 0:96eb8cc345dc | 18 | |
yaasan | 0:96eb8cc345dc | 19 | } |
yaasan | 0:96eb8cc345dc | 20 | |
yaasan | 0:96eb8cc345dc | 21 | void DSGatewayLib::begin() |
yaasan | 0:96eb8cc345dc | 22 | { |
yaasan | 0:96eb8cc345dc | 23 | /* Open SPI */ |
yaasan | 0:96eb8cc345dc | 24 | |
yaasan | 1:39249e22e9f5 | 25 | /* SPI mode is default( 8bit, mode 0, 1MHz) */ |
yaasan | 1:39249e22e9f5 | 26 | //spiDS.format(8, 0); |
yaasan | 1:39249e22e9f5 | 27 | //spiDS.frequency(1000000); |
yaasan | 1:39249e22e9f5 | 28 | cs = 1; |
yaasan | 0:96eb8cc345dc | 29 | } |
yaasan | 0:96eb8cc345dc | 30 | |
yaasan | 0:96eb8cc345dc | 31 | |
yaasan | 0:96eb8cc345dc | 32 | DSGatewayLib::~DSGatewayLib() |
yaasan | 0:96eb8cc345dc | 33 | { |
yaasan | 0:96eb8cc345dc | 34 | |
yaasan | 0:96eb8cc345dc | 35 | SetPower(false); |
yaasan | 0:96eb8cc345dc | 36 | |
yaasan | 0:96eb8cc345dc | 37 | } |
yaasan | 0:96eb8cc345dc | 38 | |
yaasan | 0:96eb8cc345dc | 39 | bool DSGatewayLib::IsPower() |
yaasan | 0:96eb8cc345dc | 40 | { |
yaasan | 0:96eb8cc345dc | 41 | |
yaasan | 0:96eb8cc345dc | 42 | return poweron; |
yaasan | 0:96eb8cc345dc | 43 | |
yaasan | 0:96eb8cc345dc | 44 | } |
yaasan | 0:96eb8cc345dc | 45 | |
yaasan | 0:96eb8cc345dc | 46 | |
yaasan | 0:96eb8cc345dc | 47 | void DSGatewayLib::clearMessage(unsigned char *inPackets) |
yaasan | 0:96eb8cc345dc | 48 | { |
yaasan | 0:96eb8cc345dc | 49 | for( int i = 0; i < SIZE_PACKET; i++) |
yaasan | 0:96eb8cc345dc | 50 | { |
yaasan | 0:96eb8cc345dc | 51 | inPackets[i] = 0; |
yaasan | 0:96eb8cc345dc | 52 | } |
yaasan | 0:96eb8cc345dc | 53 | } |
yaasan | 0:96eb8cc345dc | 54 | |
yaasan | 0:96eb8cc345dc | 55 | bool DSGatewayLib::sendMessage(unsigned char *inPackets) |
yaasan | 0:96eb8cc345dc | 56 | { |
yaasan | 0:96eb8cc345dc | 57 | byte aReceived[SIZE_PACKET] = {0,0,0,0,0,0,0,0}; |
yaasan | 0:96eb8cc345dc | 58 | int i; |
yaasan | 0:96eb8cc345dc | 59 | |
yaasan | 0:96eb8cc345dc | 60 | cs = 0; |
yaasan | 0:96eb8cc345dc | 61 | |
yaasan | 0:96eb8cc345dc | 62 | for( i = 0; i < SIZE_PACKET; i++) |
yaasan | 0:96eb8cc345dc | 63 | { |
yaasan | 1:39249e22e9f5 | 64 | aReceived[i] = reverseByte(spiDS.write(reverseByte(inPackets[i]))); |
yaasan | 0:96eb8cc345dc | 65 | } |
yaasan | 0:96eb8cc345dc | 66 | |
yaasan | 0:96eb8cc345dc | 67 | cs = 1; |
yaasan | 0:96eb8cc345dc | 68 | |
yaasan | 0:96eb8cc345dc | 69 | |
yaasan | 0:96eb8cc345dc | 70 | /* 遅延 */ |
yaasan | 1:39249e22e9f5 | 71 | wait_ms(5); |
yaasan | 1:39249e22e9f5 | 72 | |
yaasan | 0:96eb8cc345dc | 73 | /* Check for receiving */ |
yaasan | 0:96eb8cc345dc | 74 | if((aReceived[1] & 0xF0) == CMD_OK) |
yaasan | 0:96eb8cc345dc | 75 | { |
yaasan | 0:96eb8cc345dc | 76 | return true; |
yaasan | 0:96eb8cc345dc | 77 | } |
yaasan | 0:96eb8cc345dc | 78 | else if((aReceived[1] & 0xF0) == CMD_WAIT) |
yaasan | 0:96eb8cc345dc | 79 | { |
yaasan | 0:96eb8cc345dc | 80 | return true; |
yaasan | 0:96eb8cc345dc | 81 | } |
yaasan | 0:96eb8cc345dc | 82 | else |
yaasan | 0:96eb8cc345dc | 83 | { |
yaasan | 0:96eb8cc345dc | 84 | return false; |
yaasan | 0:96eb8cc345dc | 85 | } |
yaasan | 0:96eb8cc345dc | 86 | } |
yaasan | 0:96eb8cc345dc | 87 | |
yaasan | 0:96eb8cc345dc | 88 | bool DSGatewayLib::exchangeMessage(unsigned char *inPackets, word timeout) |
yaasan | 0:96eb8cc345dc | 89 | { |
yaasan | 0:96eb8cc345dc | 90 | //unsigned char aTemp[SIZE_PACKET]; |
yaasan | 0:96eb8cc345dc | 91 | |
yaasan | 0:96eb8cc345dc | 92 | bool aReturnOk = sendMessage(inPackets); |
yaasan | 0:96eb8cc345dc | 93 | |
yaasan | 0:96eb8cc345dc | 94 | /* |
yaasan | 0:96eb8cc345dc | 95 | unsigned long aTime = millis(); |
yaasan | 0:96eb8cc345dc | 96 | |
yaasan | 0:96eb8cc345dc | 97 | // response; |
yaasan | 0:96eb8cc345dc | 98 | |
yaasan | 0:96eb8cc345dc | 99 | while ((millis() < aTime + timeout) || (!aReturnOk)) { |
yaasan | 0:96eb8cc345dc | 100 | aTemp[0] = CMD_WAIT | 0b0010; |
yaasan | 0:96eb8cc345dc | 101 | aTemp[1] = aTemp[0]; |
yaasan | 0:96eb8cc345dc | 102 | |
yaasan | 0:96eb8cc345dc | 103 | delay(20); |
yaasan | 0:96eb8cc345dc | 104 | |
yaasan | 0:96eb8cc345dc | 105 | if (sendMessage(aTemp) == true) { |
yaasan | 0:96eb8cc345dc | 106 | return true; |
yaasan | 0:96eb8cc345dc | 107 | } |
yaasan | 0:96eb8cc345dc | 108 | } |
yaasan | 0:96eb8cc345dc | 109 | |
yaasan | 0:96eb8cc345dc | 110 | if (DEBUG && !aReturnOk) { |
yaasan | 0:96eb8cc345dc | 111 | Serial.println(F("!!! Communication Error(Timeout, Command etc)")); |
yaasan | 0:96eb8cc345dc | 112 | } |
yaasan | 0:96eb8cc345dc | 113 | */ |
yaasan | 0:96eb8cc345dc | 114 | |
yaasan | 0:96eb8cc345dc | 115 | return aReturnOk; |
yaasan | 0:96eb8cc345dc | 116 | } |
yaasan | 0:96eb8cc345dc | 117 | |
yaasan | 0:96eb8cc345dc | 118 | |
yaasan | 1:39249e22e9f5 | 119 | bool DSGatewayLib::SetPower(byte power) |
yaasan | 0:96eb8cc345dc | 120 | { |
yaasan | 0:96eb8cc345dc | 121 | unsigned char aPacktes[SIZE_PACKET]; |
yaasan | 0:96eb8cc345dc | 122 | |
yaasan | 0:96eb8cc345dc | 123 | clearMessage(aPacktes); |
yaasan | 0:96eb8cc345dc | 124 | |
yaasan | 1:39249e22e9f5 | 125 | if (power == 1) { |
yaasan | 0:96eb8cc345dc | 126 | aPacktes[0] = CMD_PWR_ON | 0x02; |
yaasan | 0:96eb8cc345dc | 127 | aPacktes[1] = aPacktes[0];//CRC |
yaasan | 0:96eb8cc345dc | 128 | poweron = true; |
yaasan | 0:96eb8cc345dc | 129 | |
yaasan | 0:96eb8cc345dc | 130 | } |
yaasan | 0:96eb8cc345dc | 131 | else |
yaasan | 0:96eb8cc345dc | 132 | { |
yaasan | 0:96eb8cc345dc | 133 | aPacktes[0] = CMD_PWR_OFF | 0x02; |
yaasan | 0:96eb8cc345dc | 134 | aPacktes[1] = aPacktes[0];//CRC |
yaasan | 0:96eb8cc345dc | 135 | poweron = false; |
yaasan | 0:96eb8cc345dc | 136 | } |
yaasan | 0:96eb8cc345dc | 137 | |
yaasan | 0:96eb8cc345dc | 138 | return exchangeMessage(aPacktes, TIME_REPLY); |
yaasan | 0:96eb8cc345dc | 139 | } |
yaasan | 0:96eb8cc345dc | 140 | |
yaasan | 1:39249e22e9f5 | 141 | bool DSGatewayLib::SetPowerEx(byte power) |
yaasan | 0:96eb8cc345dc | 142 | { |
yaasan | 0:96eb8cc345dc | 143 | unsigned char aPacktes[SIZE_PACKET]; |
yaasan | 0:96eb8cc345dc | 144 | |
yaasan | 0:96eb8cc345dc | 145 | clearMessage(aPacktes); |
yaasan | 0:96eb8cc345dc | 146 | |
yaasan | 1:39249e22e9f5 | 147 | if (power == 1) { |
yaasan | 0:96eb8cc345dc | 148 | aPacktes[0] = CMD_PWR_ON | 0x03; |
yaasan | 0:96eb8cc345dc | 149 | aPacktes[1] = 3;//Extend command (DCC128 and MM2-28step) |
yaasan | 0:96eb8cc345dc | 150 | aPacktes[2] = generateCRC(aPacktes, 2); |
yaasan | 0:96eb8cc345dc | 151 | |
yaasan | 0:96eb8cc345dc | 152 | } |
yaasan | 0:96eb8cc345dc | 153 | else |
yaasan | 0:96eb8cc345dc | 154 | { |
yaasan | 0:96eb8cc345dc | 155 | aPacktes[0] = CMD_PWR_OFF | 0x02; |
yaasan | 0:96eb8cc345dc | 156 | aPacktes[1] = aPacktes[0];//CRC |
yaasan | 0:96eb8cc345dc | 157 | } |
yaasan | 0:96eb8cc345dc | 158 | |
yaasan | 0:96eb8cc345dc | 159 | |
yaasan | 0:96eb8cc345dc | 160 | |
yaasan | 0:96eb8cc345dc | 161 | return exchangeMessage(aPacktes, TIME_REPLY); |
yaasan | 0:96eb8cc345dc | 162 | } |
yaasan | 0:96eb8cc345dc | 163 | |
yaasan | 0:96eb8cc345dc | 164 | bool DSGatewayLib::SetLocoSpeed(word address, int inSpeed) |
yaasan | 0:96eb8cc345dc | 165 | { |
yaasan | 0:96eb8cc345dc | 166 | unsigned char aPacktes[SIZE_PACKET]; |
yaasan | 0:96eb8cc345dc | 167 | |
yaasan | 0:96eb8cc345dc | 168 | clearMessage(aPacktes); |
yaasan | 0:96eb8cc345dc | 169 | |
yaasan | 0:96eb8cc345dc | 170 | aPacktes[0] = CMD_SPEED | 0x06; |
yaasan | 0:96eb8cc345dc | 171 | aPacktes[1] = lowByte(address); |
yaasan | 0:96eb8cc345dc | 172 | aPacktes[2] = highByte(address); |
yaasan | 0:96eb8cc345dc | 173 | aPacktes[3] = lowByte(inSpeed); |
yaasan | 0:96eb8cc345dc | 174 | aPacktes[4] = highByte(inSpeed); |
yaasan | 0:96eb8cc345dc | 175 | aPacktes[5] = generateCRC(aPacktes, 5); |
yaasan | 0:96eb8cc345dc | 176 | |
yaasan | 0:96eb8cc345dc | 177 | return exchangeMessage(aPacktes, TIME_REPLY); |
yaasan | 0:96eb8cc345dc | 178 | } |
yaasan | 0:96eb8cc345dc | 179 | |
yaasan | 0:96eb8cc345dc | 180 | |
yaasan | 0:96eb8cc345dc | 181 | bool DSGatewayLib::SetLocoSpeedEx(word address, int inSpeed, int inProtcol) |
yaasan | 0:96eb8cc345dc | 182 | { |
yaasan | 0:96eb8cc345dc | 183 | unsigned char aPacktes[SIZE_PACKET]; |
yaasan | 0:96eb8cc345dc | 184 | |
yaasan | 0:96eb8cc345dc | 185 | clearMessage(aPacktes); |
yaasan | 0:96eb8cc345dc | 186 | |
yaasan | 0:96eb8cc345dc | 187 | aPacktes[0] = CMD_SPEED | 0x07; |
yaasan | 0:96eb8cc345dc | 188 | aPacktes[1] = lowByte(address); |
yaasan | 0:96eb8cc345dc | 189 | aPacktes[2] = highByte(address); |
yaasan | 0:96eb8cc345dc | 190 | aPacktes[3] = lowByte(inSpeed); |
yaasan | 0:96eb8cc345dc | 191 | aPacktes[4] = highByte(inSpeed); |
yaasan | 0:96eb8cc345dc | 192 | aPacktes[5] = inProtcol; |
yaasan | 0:96eb8cc345dc | 193 | aPacktes[6] = generateCRC(aPacktes, 6); |
yaasan | 0:96eb8cc345dc | 194 | |
yaasan | 0:96eb8cc345dc | 195 | return exchangeMessage(aPacktes, TIME_REPLY); |
yaasan | 0:96eb8cc345dc | 196 | } |
yaasan | 0:96eb8cc345dc | 197 | |
yaasan | 0:96eb8cc345dc | 198 | bool DSGatewayLib::SetLocoFunction(word address, unsigned char inFunction, unsigned char inPower) |
yaasan | 0:96eb8cc345dc | 199 | { |
yaasan | 0:96eb8cc345dc | 200 | unsigned char aPacktes[SIZE_PACKET]; |
yaasan | 0:96eb8cc345dc | 201 | |
yaasan | 0:96eb8cc345dc | 202 | clearMessage(aPacktes); |
yaasan | 0:96eb8cc345dc | 203 | |
yaasan | 0:96eb8cc345dc | 204 | aPacktes[0] = CMD_FUNCTION | 0x06; |
yaasan | 0:96eb8cc345dc | 205 | aPacktes[1] = lowByte(address); |
yaasan | 0:96eb8cc345dc | 206 | aPacktes[2] = highByte(address); |
yaasan | 0:96eb8cc345dc | 207 | aPacktes[3] = inFunction + 1; //1はじまり |
yaasan | 0:96eb8cc345dc | 208 | aPacktes[4] = inPower; |
yaasan | 0:96eb8cc345dc | 209 | aPacktes[5] = generateCRC(aPacktes, 5); |
yaasan | 0:96eb8cc345dc | 210 | |
yaasan | 0:96eb8cc345dc | 211 | return exchangeMessage(aPacktes, TIME_REPLY); |
yaasan | 0:96eb8cc345dc | 212 | } |
yaasan | 0:96eb8cc345dc | 213 | |
yaasan | 0:96eb8cc345dc | 214 | |
yaasan | 0:96eb8cc345dc | 215 | bool DSGatewayLib::SetLocoDirection(word address, unsigned char inDirection) |
yaasan | 0:96eb8cc345dc | 216 | { |
yaasan | 0:96eb8cc345dc | 217 | unsigned char aPacktes[SIZE_PACKET]; |
yaasan | 0:96eb8cc345dc | 218 | |
yaasan | 0:96eb8cc345dc | 219 | clearMessage(aPacktes); |
yaasan | 0:96eb8cc345dc | 220 | |
yaasan | 0:96eb8cc345dc | 221 | aPacktes[0] = CMD_DIRECTION | 0x05; |
yaasan | 0:96eb8cc345dc | 222 | aPacktes[1] = lowByte(address); |
yaasan | 0:96eb8cc345dc | 223 | aPacktes[2] = highByte(address); |
yaasan | 0:96eb8cc345dc | 224 | aPacktes[3] = inDirection - 1;// FWD 1->0, REV:2->1 |
yaasan | 0:96eb8cc345dc | 225 | aPacktes[4] = generateCRC(aPacktes, 4); |
yaasan | 0:96eb8cc345dc | 226 | |
yaasan | 0:96eb8cc345dc | 227 | return exchangeMessage(aPacktes, TIME_REPLY); |
yaasan | 0:96eb8cc345dc | 228 | } |
yaasan | 0:96eb8cc345dc | 229 | |
yaasan | 0:96eb8cc345dc | 230 | /* |
yaasan | 0:96eb8cc345dc | 231 | bool DSGatewayLib::SetTurnout(word address, bool straight) |
yaasan | 0:96eb8cc345dc | 232 | { |
yaasan | 0:96eb8cc345dc | 233 | byte aSwitch = straight == true ? (byte)1 : (byte)0; |
yaasan | 0:96eb8cc345dc | 234 | |
yaasan | 0:96eb8cc345dc | 235 | return SetTurnout(address, aSwitch); |
yaasan | 0:96eb8cc345dc | 236 | }*/ |
yaasan | 0:96eb8cc345dc | 237 | |
yaasan | 0:96eb8cc345dc | 238 | bool DSGatewayLib::SetTurnout(word address, byte inSwitch) |
yaasan | 0:96eb8cc345dc | 239 | { |
yaasan | 0:96eb8cc345dc | 240 | unsigned char aPacktes[SIZE_PACKET]; |
yaasan | 0:96eb8cc345dc | 241 | |
yaasan | 0:96eb8cc345dc | 242 | clearMessage(aPacktes); |
yaasan | 0:96eb8cc345dc | 243 | |
yaasan | 0:96eb8cc345dc | 244 | aPacktes[0] = CMD_ACCESSORY | 0x06; |
yaasan | 0:96eb8cc345dc | 245 | aPacktes[1] = lowByte(address); |
yaasan | 0:96eb8cc345dc | 246 | aPacktes[2] = highByte(address); |
yaasan | 0:96eb8cc345dc | 247 | aPacktes[3] = 0x00; // position |
yaasan | 0:96eb8cc345dc | 248 | aPacktes[4] = convertAcc_MMDCC(address, inSwitch);// 0: Straight, 1: diverging from DS 1:straight, 0: diverging |
yaasan | 0:96eb8cc345dc | 249 | aPacktes[5] = generateCRC(aPacktes, 5); |
yaasan | 0:96eb8cc345dc | 250 | |
yaasan | 0:96eb8cc345dc | 251 | return exchangeMessage(aPacktes, TIME_REPLY); |
yaasan | 0:96eb8cc345dc | 252 | } |
yaasan | 0:96eb8cc345dc | 253 | |
yaasan | 0:96eb8cc345dc | 254 | byte DSGatewayLib::convertAcc_MMDCC(word address, byte inSwitch) |
yaasan | 0:96eb8cc345dc | 255 | { |
yaasan | 0:96eb8cc345dc | 256 | byte aReturn = inSwitch; |
yaasan | 0:96eb8cc345dc | 257 | |
yaasan | 0:96eb8cc345dc | 258 | switch( GetLocIDProtocol(address >> 8)) |
yaasan | 0:96eb8cc345dc | 259 | { |
yaasan | 0:96eb8cc345dc | 260 | case ADDR_ACC_MM2: |
yaasan | 0:96eb8cc345dc | 261 | /* 0:Straight, 1: diverging */ |
yaasan | 0:96eb8cc345dc | 262 | aReturn = (inSwitch == 0) ? 1 : 0; |
yaasan | 0:96eb8cc345dc | 263 | break; |
yaasan | 0:96eb8cc345dc | 264 | |
yaasan | 0:96eb8cc345dc | 265 | case ADDR_ACC_DCC: |
yaasan | 0:96eb8cc345dc | 266 | /* 1:Straight, 0: diverging */ |
yaasan | 0:96eb8cc345dc | 267 | aReturn = inSwitch; |
yaasan | 0:96eb8cc345dc | 268 | break; |
yaasan | 0:96eb8cc345dc | 269 | |
yaasan | 0:96eb8cc345dc | 270 | default: |
yaasan | 0:96eb8cc345dc | 271 | aReturn = inSwitch; |
yaasan | 0:96eb8cc345dc | 272 | break; |
yaasan | 0:96eb8cc345dc | 273 | } |
yaasan | 0:96eb8cc345dc | 274 | |
yaasan | 0:96eb8cc345dc | 275 | return aReturn; |
yaasan | 0:96eb8cc345dc | 276 | |
yaasan | 0:96eb8cc345dc | 277 | } |
yaasan | 0:96eb8cc345dc | 278 | |
yaasan | 0:96eb8cc345dc | 279 | word DSGatewayLib::GetLocIDProtocol(byte address) |
yaasan | 0:96eb8cc345dc | 280 | { |
yaasan | 0:96eb8cc345dc | 281 | if( address < 0x04) |
yaasan | 0:96eb8cc345dc | 282 | { |
yaasan | 0:96eb8cc345dc | 283 | return ADDR_MM2; |
yaasan | 0:96eb8cc345dc | 284 | } |
yaasan | 0:96eb8cc345dc | 285 | else if( (address >= 0x30) && (address <= 0x33)) |
yaasan | 0:96eb8cc345dc | 286 | { |
yaasan | 0:96eb8cc345dc | 287 | return ADDR_ACC_MM2; |
yaasan | 0:96eb8cc345dc | 288 | } |
yaasan | 0:96eb8cc345dc | 289 | else if( (address >= 0x38) && (address <= 0x3F)) |
yaasan | 0:96eb8cc345dc | 290 | { |
yaasan | 0:96eb8cc345dc | 291 | return ADDR_ACC_DCC; |
yaasan | 0:96eb8cc345dc | 292 | } |
yaasan | 0:96eb8cc345dc | 293 | else if( (address >= 0x40) && (address <= 0x70)) |
yaasan | 0:96eb8cc345dc | 294 | { |
yaasan | 0:96eb8cc345dc | 295 | return ADDR_MFX; |
yaasan | 0:96eb8cc345dc | 296 | } |
yaasan | 0:96eb8cc345dc | 297 | else if( (address >= 0xC0) && (address <= 0xFF)) |
yaasan | 0:96eb8cc345dc | 298 | { |
yaasan | 0:96eb8cc345dc | 299 | return ADDR_DCC; |
yaasan | 0:96eb8cc345dc | 300 | } |
yaasan | 0:96eb8cc345dc | 301 | else |
yaasan | 0:96eb8cc345dc | 302 | { |
yaasan | 0:96eb8cc345dc | 303 | return 0; |
yaasan | 0:96eb8cc345dc | 304 | } |
yaasan | 0:96eb8cc345dc | 305 | } |
yaasan | 0:96eb8cc345dc | 306 | |
yaasan | 0:96eb8cc345dc | 307 | bool DSGatewayLib::WriteConfig(word address, word number, byte value) |
yaasan | 0:96eb8cc345dc | 308 | { |
yaasan | 0:96eb8cc345dc | 309 | unsigned char aPacktes[SIZE_PACKET]; |
yaasan | 0:96eb8cc345dc | 310 | |
yaasan | 0:96eb8cc345dc | 311 | word aOffsetCVNo; |
yaasan | 0:96eb8cc345dc | 312 | |
yaasan | 0:96eb8cc345dc | 313 | if( address >= ADDR_DCC) |
yaasan | 0:96eb8cc345dc | 314 | { |
yaasan | 0:96eb8cc345dc | 315 | aOffsetCVNo = number; |
yaasan | 0:96eb8cc345dc | 316 | } |
yaasan | 0:96eb8cc345dc | 317 | else |
yaasan | 0:96eb8cc345dc | 318 | { |
yaasan | 0:96eb8cc345dc | 319 | aOffsetCVNo = number | 0x8000; |
yaasan | 0:96eb8cc345dc | 320 | } |
yaasan | 0:96eb8cc345dc | 321 | |
yaasan | 0:96eb8cc345dc | 322 | clearMessage(aPacktes); |
yaasan | 0:96eb8cc345dc | 323 | |
yaasan | 0:96eb8cc345dc | 324 | aPacktes[0] = CMD_CVWRITE | 0x05; |
yaasan | 0:96eb8cc345dc | 325 | aPacktes[1] = lowByte(aOffsetCVNo); |
yaasan | 0:96eb8cc345dc | 326 | aPacktes[2] = highByte(aOffsetCVNo); |
yaasan | 0:96eb8cc345dc | 327 | aPacktes[3] = value; |
yaasan | 0:96eb8cc345dc | 328 | aPacktes[4] = generateCRC(aPacktes, 4); |
yaasan | 0:96eb8cc345dc | 329 | |
yaasan | 0:96eb8cc345dc | 330 | return exchangeMessage(aPacktes, TIME_REPLY); |
yaasan | 0:96eb8cc345dc | 331 | } |
yaasan | 0:96eb8cc345dc | 332 | |
yaasan | 0:96eb8cc345dc | 333 | bool DSGatewayLib::ReadConfig(word address, word number, byte *value) |
yaasan | 0:96eb8cc345dc | 334 | { |
yaasan | 0:96eb8cc345dc | 335 | unsigned char aPacktes[SIZE_PACKET]; |
yaasan | 0:96eb8cc345dc | 336 | |
yaasan | 0:96eb8cc345dc | 337 | clearMessage(aPacktes); |
yaasan | 0:96eb8cc345dc | 338 | |
yaasan | 0:96eb8cc345dc | 339 | aPacktes[0] = CMD_CVREAD || 0x04; |
yaasan | 0:96eb8cc345dc | 340 | aPacktes[1] = lowByte(number); |
yaasan | 0:96eb8cc345dc | 341 | aPacktes[2] = highByte(number); |
yaasan | 0:96eb8cc345dc | 342 | aPacktes[3] = generateCRC(aPacktes, 3); |
yaasan | 0:96eb8cc345dc | 343 | |
yaasan | 0:96eb8cc345dc | 344 | *value = 0; |
yaasan | 0:96eb8cc345dc | 345 | |
yaasan | 0:96eb8cc345dc | 346 | return exchangeMessage(aPacktes, TIME_REPLY); |
yaasan | 0:96eb8cc345dc | 347 | } |
yaasan | 0:96eb8cc345dc | 348 | |
yaasan | 0:96eb8cc345dc | 349 | |
yaasan | 0:96eb8cc345dc | 350 | unsigned char DSGatewayLib::generateCRC(unsigned char *inPackets, unsigned char inLen) |
yaasan | 0:96eb8cc345dc | 351 | { |
yaasan | 0:96eb8cc345dc | 352 | unsigned char aCRC = inPackets[0]; |
yaasan | 0:96eb8cc345dc | 353 | |
yaasan | 0:96eb8cc345dc | 354 | for( int i = 1; i < inLen; i++) |
yaasan | 0:96eb8cc345dc | 355 | { |
yaasan | 0:96eb8cc345dc | 356 | aCRC = aCRC ^ inPackets[i]; |
yaasan | 0:96eb8cc345dc | 357 | } |
yaasan | 0:96eb8cc345dc | 358 | |
yaasan | 0:96eb8cc345dc | 359 | return aCRC; |
yaasan | 0:96eb8cc345dc | 360 | |
yaasan | 0:96eb8cc345dc | 361 | } |
yaasan | 0:96eb8cc345dc | 362 | |
yaasan | 0:96eb8cc345dc | 363 | byte lowByte(short int low) { |
yaasan | 0:96eb8cc345dc | 364 | byte bytelow = 0; |
yaasan | 0:96eb8cc345dc | 365 | bytelow = (low & 0xFF); |
yaasan | 0:96eb8cc345dc | 366 | return bytelow; |
yaasan | 0:96eb8cc345dc | 367 | } |
yaasan | 0:96eb8cc345dc | 368 | |
yaasan | 0:96eb8cc345dc | 369 | byte highByte(short int high) { |
yaasan | 0:96eb8cc345dc | 370 | byte bytehigh = 0; |
yaasan | 0:96eb8cc345dc | 371 | bytehigh = ((high >> 8) & 0xFF); |
yaasan | 0:96eb8cc345dc | 372 | return bytehigh; |
yaasan | 1:39249e22e9f5 | 373 | } |
yaasan | 1:39249e22e9f5 | 374 | |
yaasan | 1:39249e22e9f5 | 375 | unsigned char reverseByte(unsigned char inByte) |
yaasan | 1:39249e22e9f5 | 376 | { |
yaasan | 1:39249e22e9f5 | 377 | |
yaasan | 1:39249e22e9f5 | 378 | unsigned char aTemp = 0; |
yaasan | 1:39249e22e9f5 | 379 | |
yaasan | 1:39249e22e9f5 | 380 | for( int i = 0; i < 8; i++) |
yaasan | 1:39249e22e9f5 | 381 | { |
yaasan | 1:39249e22e9f5 | 382 | aTemp = aTemp | (((inByte >> i) & 0x01) << (7 - i)); |
yaasan | 1:39249e22e9f5 | 383 | } |
yaasan | 1:39249e22e9f5 | 384 | |
yaasan | 1:39249e22e9f5 | 385 | return aTemp; |
yaasan | 1:39249e22e9f5 | 386 | |
yaasan | 0:96eb8cc345dc | 387 | } |