Denver
/
denver_train_proj
Denver trai project
main.cpp@22:e4153ca757dd, 2018-06-11 (annotated)
- Committer:
- mglmx
- Date:
- Mon Jun 11 12:22:13 2018 +0000
- Revision:
- 22:e4153ca757dd
- Parent:
- 21:e6f1649add39
- Child:
- 23:3fe9e76e06f2
Monday commit
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
mglmx | 0:4d06a6a8e785 | 1 | #include "mbed.h" |
mglmx | 3:fe7010b693a0 | 2 | #include "TextLCD.h" |
mglmx | 18:aa43bb62e60f | 3 | #include "MCP23017.h" |
mglmx | 22:e4153ca757dd | 4 | #include <string> |
mglmx | 22:e4153ca757dd | 5 | #include <iostream> |
mglmx | 18:aa43bb62e60f | 6 | |
mglmx | 1:0ab26889af9b | 7 | //mbed DCC Model Train Demo |
mglmx | 1:0ab26889af9b | 8 | |
carlosperales95 | 7:e2b8461d4f05 | 9 | /******PINS AND DECLARATIONS*******/ |
carlosperales95 | 7:e2b8461d4f05 | 10 | |
mglmx | 21:e6f1649add39 | 11 | |
mglmx | 21:e6f1649add39 | 12 | //SWITCHES p5 - p8 |
mglmx | 21:e6f1649add39 | 13 | DigitalIn switch1(p5); |
mglmx | 21:e6f1649add39 | 14 | DigitalIn switch2(p6); |
mglmx | 21:e6f1649add39 | 15 | DigitalIn switch3(p7); |
mglmx | 21:e6f1649add39 | 16 | DigitalIn switch4(p8); |
carlosperales95 | 7:e2b8461d4f05 | 17 | |
carlosperales95 | 10:2088b1935a93 | 18 | //RAIL SENSORS - INT0,INT1 |
carlosperales95 | 7:e2b8461d4f05 | 19 | //INT0 - p9 |
mglmx | 18:aa43bb62e60f | 20 | InterruptIn int0(p9); |
carlosperales95 | 7:e2b8461d4f05 | 21 | //INT1 - p10 |
mglmx | 18:aa43bb62e60f | 22 | InterruptIn int1(p10); |
carlosperales95 | 7:e2b8461d4f05 | 23 | |
carlosperales95 | 7:e2b8461d4f05 | 24 | ///p11 |
carlosperales95 | 7:e2b8461d4f05 | 25 | ///p12 |
carlosperales95 | 12:e914ca5cd44b | 26 | |
carlosperales95 | 7:e2b8461d4f05 | 27 | //M0 - p13 |
carlosperales95 | 7:e2b8461d4f05 | 28 | DigitalIn d21(p13); |
carlosperales95 | 7:e2b8461d4f05 | 29 | //M1 - p14 |
carlosperales95 | 7:e2b8461d4f05 | 30 | DigitalIn d22(p14); |
carlosperales95 | 7:e2b8461d4f05 | 31 | //M2 - p15 |
carlosperales95 | 7:e2b8461d4f05 | 32 | DigitalIn d23(p15); |
carlosperales95 | 12:e914ca5cd44b | 33 | |
carlosperales95 | 7:e2b8461d4f05 | 34 | //p16 |
carlosperales95 | 12:e914ca5cd44b | 35 | //p17 |
carlosperales95 | 12:e914ca5cd44b | 36 | |
carlosperales95 | 11:021210c59a95 | 37 | //BUZZER - p18 |
carlosperales95 | 11:021210c59a95 | 38 | DigitalOut buzz(p18); // buzz=0 doesn't beep, buzz=1 beeps |
carlosperales95 | 7:e2b8461d4f05 | 39 | |
carlosperales95 | 7:e2b8461d4f05 | 40 | //POTENTIOMETER - p19 |
carlosperales95 | 13:dbf1ead12cee | 41 | AnalogIn pot(p19); //Gives float value pot.read(). Convert analog input to V with f*3.3 |
carlosperales95 | 7:e2b8461d4f05 | 42 | |
carlosperales95 | 7:e2b8461d4f05 | 43 | //DAT - p20 |
mglmx | 3:fe7010b693a0 | 44 | DigitalOut Track(p20); //Digital output bit used to drive track power via H-bridge |
carlosperales95 | 7:e2b8461d4f05 | 45 | |
carlosperales95 | 7:e2b8461d4f05 | 46 | //LCD SCREEN - p21, p22, p23, p24, p25, p26 |
carlosperales95 | 11:021210c59a95 | 47 | TextLCD lcd(p22,p21,p23,p24,p25,p26); // RS, E, A4, A5, A6, A7 // ldc.cls() to clear and printf(String up to 16char) |
carlosperales95 | 7:e2b8461d4f05 | 48 | |
carlosperales95 | 7:e2b8461d4f05 | 49 | ///p27 |
carlosperales95 | 7:e2b8461d4f05 | 50 | ///p28 |
carlosperales95 | 7:e2b8461d4f05 | 51 | |
carlosperales95 | 7:e2b8461d4f05 | 52 | //LED1 - p29 |
mglmx | 3:fe7010b693a0 | 53 | DigitalOut redled(p29); |
carlosperales95 | 7:e2b8461d4f05 | 54 | //LED2 - p30 |
mglmx | 3:fe7010b693a0 | 55 | DigitalOut greenled(p30); |
carlosperales95 | 7:e2b8461d4f05 | 56 | |
mglmx | 18:aa43bb62e60f | 57 | DigitalOut led1(LED1); |
mglmx | 18:aa43bb62e60f | 58 | DigitalOut led2(LED2); |
mglmx | 18:aa43bb62e60f | 59 | DigitalOut led3(LED3); |
mglmx | 16:2a2da0e67793 | 60 | |
mglmx | 16:2a2da0e67793 | 61 | //MCP |
mglmx | 16:2a2da0e67793 | 62 | MCP23017 *mcp; |
carlosperales95 | 12:e914ca5cd44b | 63 | |
carlosperales95 | 11:021210c59a95 | 64 | //**************** FUNCTIONS FOR DENVER TRAIN ****************// |
carlosperales95 | 10:2088b1935a93 | 65 | |
mglmx | 18:aa43bb62e60f | 66 | |
mglmx | 22:e4153ca757dd | 67 | /** |
mglmx | 22:e4153ca757dd | 68 | * Activates the buzzer for 0.5 seconds. |
mglmx | 22:e4153ca757dd | 69 | **/ |
mglmx | 22:e4153ca757dd | 70 | void doBuzz(){ |
mglmx | 22:e4153ca757dd | 71 | buzz = 1; |
mglmx | 22:e4153ca757dd | 72 | wait(0.5); |
mglmx | 22:e4153ca757dd | 73 | buzz = 0; |
mglmx | 22:e4153ca757dd | 74 | } |
mglmx | 18:aa43bb62e60f | 75 | |
mglmx | 22:e4153ca757dd | 76 | /** |
mglmx | 22:e4153ca757dd | 77 | |
mglmx | 22:e4153ca757dd | 78 | */ |
mglmx | 18:aa43bb62e60f | 79 | void initialize_mcp(){ |
mglmx | 18:aa43bb62e60f | 80 | mcp = new MCP23017(p28,p27,0x40); //Connect to SCL - p28 and SDA - p27 and MPC I2C address 0x40 |
mglmx | 18:aa43bb62e60f | 81 | |
mglmx | 18:aa43bb62e60f | 82 | mcp->reset(); |
mglmx | 18:aa43bb62e60f | 83 | mcp->writeRegister(0x00, (unsigned char )0xff); |
mglmx | 18:aa43bb62e60f | 84 | mcp->writeRegister(0x01, (unsigned char )0xff); |
mglmx | 18:aa43bb62e60f | 85 | mcp->writeRegister(0x02, (unsigned char )0x00); |
mglmx | 18:aa43bb62e60f | 86 | mcp->writeRegister(0x03, (unsigned char )0x00); |
mglmx | 18:aa43bb62e60f | 87 | mcp->writeRegister(0x04, (unsigned char )0xff); |
mglmx | 18:aa43bb62e60f | 88 | mcp->writeRegister(0x05, (unsigned char )0xff); |
mglmx | 18:aa43bb62e60f | 89 | mcp->writeRegister(0x06, (unsigned char )0xff); |
mglmx | 18:aa43bb62e60f | 90 | mcp->writeRegister(0x07, (unsigned char )0xff); |
mglmx | 18:aa43bb62e60f | 91 | mcp->writeRegister(0x08, (unsigned char )0xff); |
mglmx | 18:aa43bb62e60f | 92 | mcp->writeRegister(0x09, (unsigned char )0xff); |
mglmx | 18:aa43bb62e60f | 93 | mcp->writeRegister(0x0a, (unsigned char )0x42); |
mglmx | 18:aa43bb62e60f | 94 | mcp->writeRegister(0x0b, (unsigned char )0x42); |
mglmx | 18:aa43bb62e60f | 95 | mcp->writeRegister(0x0c, (unsigned char )0x00); |
mglmx | 18:aa43bb62e60f | 96 | mcp->writeRegister(0x0d, (unsigned char )0x00); |
mglmx | 18:aa43bb62e60f | 97 | } |
mglmx | 18:aa43bb62e60f | 98 | |
mglmx | 16:2a2da0e67793 | 99 | void interrupt0(){ |
mglmx | 16:2a2da0e67793 | 100 | int data = mcp->readRegister(GPIO); |
mglmx | 17:0a657e338356 | 101 | lcd.cls(); |
mglmx | 22:e4153ca757dd | 102 | lcd.printf("int0 %x",data); |
mglmx | 22:e4153ca757dd | 103 | redled = 1; |
mglmx | 22:e4153ca757dd | 104 | wait(0.2); |
mglmx | 22:e4153ca757dd | 105 | redled = 0; |
mglmx | 22:e4153ca757dd | 106 | |
mglmx | 16:2a2da0e67793 | 107 | } |
mglmx | 16:2a2da0e67793 | 108 | |
mglmx | 16:2a2da0e67793 | 109 | void interrupt1(){ |
mglmx | 16:2a2da0e67793 | 110 | int data = mcp->readRegister(GPIO); |
mglmx | 17:0a657e338356 | 111 | lcd.cls(); |
mglmx | 22:e4153ca757dd | 112 | lcd.printf("int1 %x",data); |
mglmx | 22:e4153ca757dd | 113 | greenled = 1; |
mglmx | 22:e4153ca757dd | 114 | wait(0.2); |
mglmx | 22:e4153ca757dd | 115 | greenled = 0; |
mglmx | 16:2a2da0e67793 | 116 | } |
mglmx | 5:ce0f66ea12c5 | 117 | |
mglmx | 1:0ab26889af9b | 118 | |
mglmx | 1:0ab26889af9b | 119 | void DCC_send_command(unsigned int address, unsigned int inst, unsigned int repeat_count) |
mglmx | 1:0ab26889af9b | 120 | { |
mglmx | 1:0ab26889af9b | 121 | unsigned __int64 command = 0x0000000000000000; // __int64 is the 64-bit integer type |
mglmx | 1:0ab26889af9b | 122 | unsigned __int64 temp_command = 0x0000000000000000; |
mglmx | 1:0ab26889af9b | 123 | unsigned __int64 prefix = 0x3FFF; // 14 "1" bits needed at start |
mglmx | 1:0ab26889af9b | 124 | unsigned int error = 0x00; //error byte |
mglmx | 1:0ab26889af9b | 125 | //calculate error detection byte with xor |
mglmx | 1:0ab26889af9b | 126 | error = address ^ inst; |
mglmx | 1:0ab26889af9b | 127 | //combine packet bits in basic DCC format |
mglmx | 1:0ab26889af9b | 128 | command = (prefix<<28)|(address<<19)|(inst<<10)|((error)<<1)|0x01; |
mglmx | 1:0ab26889af9b | 129 | //printf("\n\r %llx \n\r",command); |
mglmx | 1:0ab26889af9b | 130 | int i=0; |
mglmx | 1:0ab26889af9b | 131 | //repeat DCC command lots of times |
mglmx | 1:0ab26889af9b | 132 | while(i < repeat_count) { |
mglmx | 1:0ab26889af9b | 133 | temp_command = command; |
mglmx | 1:0ab26889af9b | 134 | //loops through packet bits encoding and sending out digital pulses for a DCC command |
mglmx | 1:0ab26889af9b | 135 | for (int j=0; j<64; j++) { |
mglmx | 1:0ab26889af9b | 136 | if((temp_command&0x8000000000000000)==0) { //test packet bit |
mglmx | 1:0ab26889af9b | 137 | //send data for a "0" bit |
mglmx | 1:0ab26889af9b | 138 | Track=0; |
mglmx | 1:0ab26889af9b | 139 | wait_us(100); |
mglmx | 1:0ab26889af9b | 140 | Track=1; |
mglmx | 1:0ab26889af9b | 141 | wait_us(100); |
mglmx | 1:0ab26889af9b | 142 | //printf("0011"); |
mglmx | 1:0ab26889af9b | 143 | } else { |
mglmx | 1:0ab26889af9b | 144 | //send data for a "1"bit |
mglmx | 1:0ab26889af9b | 145 | Track=0; |
mglmx | 1:0ab26889af9b | 146 | wait_us(58); |
mglmx | 1:0ab26889af9b | 147 | Track=1; |
mglmx | 1:0ab26889af9b | 148 | wait_us(58); |
mglmx | 1:0ab26889af9b | 149 | //printf("01"); |
mglmx | 1:0ab26889af9b | 150 | } |
mglmx | 1:0ab26889af9b | 151 | // next bit in packet |
mglmx | 1:0ab26889af9b | 152 | temp_command = temp_command<<1; |
mglmx | 1:0ab26889af9b | 153 | } |
mglmx | 1:0ab26889af9b | 154 | i++; |
mglmx | 0:4d06a6a8e785 | 155 | } |
mglmx | 0:4d06a6a8e785 | 156 | } |
carlosperales95 | 11:021210c59a95 | 157 | |
mglmx | 21:e6f1649add39 | 158 | void flipSwitch(int switchId, int times){ |
mglmx | 21:e6f1649add39 | 159 | //Command variables for Switches using DCC |
mglmx | 21:e6f1649add39 | 160 | |
mglmx | 21:e6f1649add39 | 161 | unsigned int SWBaddress = 0x06; //address for switch box |
mglmx | 21:e6f1649add39 | 162 | |
mglmx | 21:e6f1649add39 | 163 | ////100DDDDD where DDDDD |
mglmx | 21:e6f1649add39 | 164 | ///00001 to flip the first switch SW1 (F1 active) |
mglmx | 21:e6f1649add39 | 165 | ///00010 to flip the second switch SW2 (F2 active) |
mglmx | 21:e6f1649add39 | 166 | ///00100 to flip the third switch SW3 (F3 active) |
mglmx | 21:e6f1649add39 | 167 | ///01000 to flip the fourth switch SW4 (F4 active) |
mglmx | 22:e4153ca757dd | 168 | |
mglmx | 22:e4153ca757dd | 169 | /// 00011 maybe flips 1 and 2 |
mglmx | 22:e4153ca757dd | 170 | |
mglmx | 21:e6f1649add39 | 171 | //example - 111111 0 00000101 0 10000000 0 10000101 1 - idleç |
mglmx | 21:e6f1649add39 | 172 | |
mglmx | 21:e6f1649add39 | 173 | unsigned int SWBflip = 0x80; //No switches -- idle |
mglmx | 21:e6f1649add39 | 174 | |
mglmx | 21:e6f1649add39 | 175 | switch(switchId){ |
mglmx | 21:e6f1649add39 | 176 | case 1: |
mglmx | 21:e6f1649add39 | 177 | SWBflip = 0x81; //FLIP 1 |
mglmx | 21:e6f1649add39 | 178 | break; |
mglmx | 21:e6f1649add39 | 179 | case 2: |
mglmx | 21:e6f1649add39 | 180 | SWBflip = 0x82; |
mglmx | 21:e6f1649add39 | 181 | break; |
mglmx | 21:e6f1649add39 | 182 | case 3: |
mglmx | 21:e6f1649add39 | 183 | SWBflip = 0x84; |
mglmx | 21:e6f1649add39 | 184 | break; |
mglmx | 21:e6f1649add39 | 185 | case 4: |
mglmx | 22:e4153ca757dd | 186 | SWBflip = 0x88; |
mglmx | 21:e6f1649add39 | 187 | break; |
mglmx | 21:e6f1649add39 | 188 | default: |
mglmx | 21:e6f1649add39 | 189 | break; |
mglmx | 21:e6f1649add39 | 190 | |
mglmx | 21:e6f1649add39 | 191 | } |
carlosperales95 | 11:021210c59a95 | 192 | |
mglmx | 21:e6f1649add39 | 193 | //Security measure not to burn the switch. |
mglmx | 21:e6f1649add39 | 194 | if(times <=5){ |
mglmx | 21:e6f1649add39 | 195 | DCC_send_command(SWBaddress,SWBflip,times); |
mglmx | 21:e6f1649add39 | 196 | } |
mglmx | 21:e6f1649add39 | 197 | |
mglmx | 21:e6f1649add39 | 198 | |
mglmx | 21:e6f1649add39 | 199 | } |
mglmx | 21:e6f1649add39 | 200 | |
mglmx | 22:e4153ca757dd | 201 | |
mglmx | 22:e4153ca757dd | 202 | |
mglmx | 22:e4153ca757dd | 203 | /* |
mglmx | 22:e4153ca757dd | 204 | Check the swithces of the box. If they have 1 value the railSiwtches flip. |
mglmx | 22:e4153ca757dd | 205 | */ |
mglmx | 22:e4153ca757dd | 206 | |
mglmx | 22:e4153ca757dd | 207 | void switching(string sw1,string sw2, string sw3, string sw4){ |
mglmx | 22:e4153ca757dd | 208 | string strInst = "1000" + sw1 + sw2 + sw3 + sw4; |
mglmx | 22:e4153ca757dd | 209 | |
mglmx | 22:e4153ca757dd | 210 | //unsigned int inst = stoi(strInst); |
mglmx | 22:e4153ca757dd | 211 | |
mglmx | 22:e4153ca757dd | 212 | |
mglmx | 22:e4153ca757dd | 213 | //DCC_send_command(0x06,inst,5); |
mglmx | 22:e4153ca757dd | 214 | |
mglmx | 22:e4153ca757dd | 215 | |
mglmx | 22:e4153ca757dd | 216 | } |
mglmx | 22:e4153ca757dd | 217 | |
mglmx | 21:e6f1649add39 | 218 | void checkSwitch(){ |
mglmx | 22:e4153ca757dd | 219 | if(switch1 == 1){ |
mglmx | 22:e4153ca757dd | 220 | lcd.cls(); |
mglmx | 22:e4153ca757dd | 221 | lcd.printf("Switch 1 ON - SW1"); |
mglmx | 22:e4153ca757dd | 222 | flipSwitch(1,5); //IDLE |
mglmx | 22:e4153ca757dd | 223 | }else if(switch2 == 1){ |
mglmx | 22:e4153ca757dd | 224 | lcd.cls(); |
mglmx | 22:e4153ca757dd | 225 | lcd.printf("Switch 2 ON - SW2"); |
mglmx | 22:e4153ca757dd | 226 | flipSwitch(2,5); |
mglmx | 22:e4153ca757dd | 227 | } else if(switch3 == 0){ |
mglmx | 22:e4153ca757dd | 228 | lcd.cls(); |
mglmx | 22:e4153ca757dd | 229 | lcd.printf("Switch 3 ON - SW3"); |
mglmx | 22:e4153ca757dd | 230 | flipSwitch(3,5); |
mglmx | 22:e4153ca757dd | 231 | } else if(switch4 == 0){ |
mglmx | 22:e4153ca757dd | 232 | lcd.cls(); |
mglmx | 22:e4153ca757dd | 233 | lcd.printf("Switch 4 ON - IDLE"); |
mglmx | 22:e4153ca757dd | 234 | flipSwitch(0,5); |
mglmx | 22:e4153ca757dd | 235 | } |
mglmx | 22:e4153ca757dd | 236 | |
mglmx | 21:e6f1649add39 | 237 | } |
mglmx | 22:e4153ca757dd | 238 | /* |
mglmx | 22:e4153ca757dd | 239 | void checkSwitch(){ |
mglmx | 22:e4153ca757dd | 240 | int switches[] = [0,0,0,0] |
mglmx | 22:e4153ca757dd | 241 | bool changed = false; |
mglmx | 22:e4153ca757dd | 242 | if(switch1 == 1){ |
mglmx | 22:e4153ca757dd | 243 | changed = true; |
mglmx | 22:e4153ca757dd | 244 | switches[0]=1; |
mglmx | 22:e4153ca757dd | 245 | } |
mglmx | 22:e4153ca757dd | 246 | if(switch2 == 1){ |
mglmx | 22:e4153ca757dd | 247 | changed = true; |
mglmx | 22:e4153ca757dd | 248 | switches[1]=1; |
mglmx | 22:e4153ca757dd | 249 | } |
mglmx | 22:e4153ca757dd | 250 | if(switch3 == 1){ |
mglmx | 22:e4153ca757dd | 251 | changed = true; |
mglmx | 22:e4153ca757dd | 252 | switches[2]=1; |
mglmx | 22:e4153ca757dd | 253 | } |
mglmx | 22:e4153ca757dd | 254 | if(switch4 == 1){ |
mglmx | 22:e4153ca757dd | 255 | changed = true; |
mglmx | 22:e4153ca757dd | 256 | switches[3]=1; |
mglmx | 22:e4153ca757dd | 257 | |
mglmx | 22:e4153ca757dd | 258 | } |
mglmx | 22:e4153ca757dd | 259 | |
mglmx | 22:e4153ca757dd | 260 | if(changed){ |
mglmx | 22:e4153ca757dd | 261 | switching(switches[0],switches[) |
mglmx | 22:e4153ca757dd | 262 | } |
mglmx | 22:e4153ca757dd | 263 | |
mglmx | 22:e4153ca757dd | 264 | |
mglmx | 22:e4153ca757dd | 265 | } |
mglmx | 22:e4153ca757dd | 266 | |
mglmx | 22:e4153ca757dd | 267 | */ |
carlosperales95 | 12:e914ca5cd44b | 268 | |
carlosperales95 | 11:021210c59a95 | 269 | //**************** MAIN PROGRAM FOR DENVER TRAIN ****************// |
carlosperales95 | 11:021210c59a95 | 270 | |
mglmx | 1:0ab26889af9b | 271 | int main() |
mglmx | 1:0ab26889af9b | 272 | { |
mglmx | 2:f580707c44fa | 273 | led1 = 1; |
mglmx | 22:e4153ca757dd | 274 | wait(0.2); |
mglmx | 2:f580707c44fa | 275 | led1 = 0; |
mglmx | 22:e4153ca757dd | 276 | wait(0.2); |
mglmx | 2:f580707c44fa | 277 | led1 = 1; |
mglmx | 16:2a2da0e67793 | 278 | |
mglmx | 16:2a2da0e67793 | 279 | initialize_mcp(); |
mglmx | 16:2a2da0e67793 | 280 | |
mglmx | 22:e4153ca757dd | 281 | //int0.rise(&interrupt0); |
mglmx | 22:e4153ca757dd | 282 | //int1.rise(&interrupt1); |
mglmx | 22:e4153ca757dd | 283 | |
mglmx | 22:e4153ca757dd | 284 | |
mglmx | 1:0ab26889af9b | 285 | //typical out of box default engine DCC address is 3 (at least for Bachmann trains) |
mglmx | 1:0ab26889af9b | 286 | //Note: A DCC controller can reprogram the address whenever needed |
mglmx | 1:0ab26889af9b | 287 | unsigned int DCCaddress = 0x01; |
mglmx | 1:0ab26889af9b | 288 | //see http://www.nmra.org/standards/DCC/standards_rps/RP-921%202006%20Aug%2021.pdf |
mglmx | 1:0ab26889af9b | 289 | //01DCSSSS for speed, D is direction (fwd=1 and rev=0), C is speed(SSSSC) LSB |
mglmx | 1:0ab26889af9b | 290 | unsigned int DCCinst_forward = 0x68; //forward half speed |
mglmx | 1:0ab26889af9b | 291 | unsigned int DCCinst_reverse = 0x48; //reverse half speed |
mglmx | 4:50879dfb82d5 | 292 | unsigned int DCCinst_stop = 0x50; |
mglmx | 1:0ab26889af9b | 293 | //100DDDDD for basic headlight functions |
mglmx | 1:0ab26889af9b | 294 | unsigned int DCC_func_lighton = 0x90; //F0 turns on headlight function |
mglmx | 1:0ab26889af9b | 295 | unsigned int DCC_func_dimlight = 0x91; //F0 + F1 dims headlight |
mglmx | 1:0ab26889af9b | 296 | // |
mglmx | 1:0ab26889af9b | 297 | //Basic DCC Demo Commands |
mglmx | 1:0ab26889af9b | 298 | DCC_send_command(DCCaddress,DCC_func_lighton,200); // turn light on full |
mglmx | 1:0ab26889af9b | 299 | DCC_send_command(DCCaddress,DCC_func_dimlight,200); //dim light |
mglmx | 1:0ab26889af9b | 300 | DCC_send_command(DCCaddress,DCC_func_lighton,200); //light full again |
mglmx | 22:e4153ca757dd | 301 | |
mglmx | 22:e4153ca757dd | 302 | |
mglmx | 22:e4153ca757dd | 303 | //DCC_send_command(0x06,0x8F,5); ALL SWITCHES |
carlosperales95 | 19:ff21ba3a4dc5 | 304 | |
mglmx | 22:e4153ca757dd | 305 | led3 = 1; // Entering the while |
carlosperales95 | 19:ff21ba3a4dc5 | 306 | |
mglmx | 22:e4153ca757dd | 307 | lcd.cls(); |
mglmx | 22:e4153ca757dd | 308 | lcd.printf("Ready to start"); |
carlosperales95 | 19:ff21ba3a4dc5 | 309 | |
carlosperales95 | 14:7bb998edd819 | 310 | //Demo for stopping at the station |
mglmx | 1:0ab26889af9b | 311 | while(1) { |
mglmx | 4:50879dfb82d5 | 312 | |
mglmx | 4:50879dfb82d5 | 313 | if(d21 == 1 || d22 == 1 || d23 == 1){ |
carlosperales95 | 14:7bb998edd819 | 314 | |
mglmx | 4:50879dfb82d5 | 315 | lcd.cls(); |
mglmx | 4:50879dfb82d5 | 316 | lcd.printf("Choo Choo station"); |
carlosperales95 | 14:7bb998edd819 | 317 | DCC_send_command(DCCaddress,DCCinst_stop,400); // Stop train address 3 |
mglmx | 22:e4153ca757dd | 318 | checkSwitch(); |
mglmx | 4:50879dfb82d5 | 319 | |
mglmx | 22:e4153ca757dd | 320 | }else{ |
mglmx | 22:e4153ca757dd | 321 | checkSwitch(); |
carlosperales95 | 14:7bb998edd819 | 322 | DCC_send_command(DCCaddress,DCCinst_forward,1); // Forward half speed train address 3 |
mglmx | 4:50879dfb82d5 | 323 | } |
mglmx | 4:50879dfb82d5 | 324 | |
mglmx | 4:50879dfb82d5 | 325 | |
mglmx | 4:50879dfb82d5 | 326 | /* |
mglmx | 3:fe7010b693a0 | 327 | float f = pot.read(); |
mglmx | 3:fe7010b693a0 | 328 | float vin = f * 3.3; |
mglmx | 3:fe7010b693a0 | 329 | |
mglmx | 2:f580707c44fa | 330 | led3 = 1; |
mglmx | 3:fe7010b693a0 | 331 | if(switch1 == 1){ |
mglmx | 3:fe7010b693a0 | 332 | lcd.cls(); |
mglmx | 3:fe7010b693a0 | 333 | lcd.printf("Going forward"); |
mglmx | 3:fe7010b693a0 | 334 | greenled = 0; |
mglmx | 3:fe7010b693a0 | 335 | redled = 1; |
mglmx | 3:fe7010b693a0 | 336 | DCC_send_command(DCCaddress,DCCinst_forward,400); // forward half speed train address 3 |
mglmx | 3:fe7010b693a0 | 337 | lcd.cls(); |
mglmx | 3:fe7010b693a0 | 338 | |
mglmx | 3:fe7010b693a0 | 339 | lcd.printf("vin: %.4f",vin); |
mglmx | 3:fe7010b693a0 | 340 | wait(0.2); |
mglmx | 3:fe7010b693a0 | 341 | |
mglmx | 3:fe7010b693a0 | 342 | }else{ |
mglmx | 3:fe7010b693a0 | 343 | lcd.cls(); |
mglmx | 3:fe7010b693a0 | 344 | lcd.printf("Going backwards"); |
mglmx | 3:fe7010b693a0 | 345 | greenled = 1; |
mglmx | 3:fe7010b693a0 | 346 | redled = 0; |
mglmx | 3:fe7010b693a0 | 347 | DCC_send_command(DCCaddress,DCCinst_reverse,400); // reverse half speed train address 3 |
mglmx | 3:fe7010b693a0 | 348 | lcd.cls(); |
mglmx | 3:fe7010b693a0 | 349 | |
mglmx | 3:fe7010b693a0 | 350 | lcd.printf("vin: %.4f",vin); |
mglmx | 3:fe7010b693a0 | 351 | wait(0.2); |
mglmx | 3:fe7010b693a0 | 352 | |
mglmx | 3:fe7010b693a0 | 353 | } |
mglmx | 4:50879dfb82d5 | 354 | */ |
mglmx | 1:0ab26889af9b | 355 | } |
mglmx | 3:fe7010b693a0 | 356 | } |