Curtis Mulady / Mbed 2 deprecated 4180_mP_WirelessPong_revC

ir stuff working nicely. rx on interrupt. tx is blocking.

Fork of 4180_mP_WirelessPong_revB by Curtis Mulady

main.cpp@16:bc0e213ba52d, 2012-10-06 (annotated)

Committer:
cmulady
Date:
Sat Oct 06 12:52:35 2012 +0000
Revision:
16:bc0e213ba52d
Parent:
15:21c512907cf6
Child:
17:f92e4a384637
kinda sorta working

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cmulady 0:c8ddcaa575ba 1 #include "mbed.h"
cmulady 0:c8ddcaa575ba 2 #include "rtos.h"
cmulady 0:c8ddcaa575ba 3 #include "NokiaLCD.h"
cmulady 1:9ba884d85ac6 4 #include "XMIT_IR.h"
cmulady 0:c8ddcaa575ba 5
cmulady 1:9ba884d85ac6 6 #define FPS 5
cmulady 1:9ba884d85ac6 7
cmulady 3:8e492eacd346 8 /****************************************
cmulady 3:8e492eacd346 9 |=======================================|
cmulady 3:8e492eacd346 10 |MBED Connections: |
cmulady 3:8e492eacd346 11 | -p5 : DIO on Sparkfun Nokia LCD |
cmulady 3:8e492eacd346 12 | -p7 : CLK on Sparkfun Nokia LCD |
cmulady 3:8e492eacd346 13 | -p8 : CS on Sparkfun Nokia LCD |
cmulady 3:8e492eacd346 14 | -p9 : RST on Sparkfun Nokia LCD |
cmulady 12:9acca1dd0e8e 15 | -p21: CTL on Sparkfun IR Xmitter |
cmulady 12:9acca1dd0e8e 16 | -p14: OUT on Sparkfun IR Rcvr |
cmulady 12:9acca1dd0e8e 17 | -p13: GND on Sparkfun IR Xmitter |
cmulady 3:8e492eacd346 18 |=======================================|
cmulady 3:8e492eacd346 19 ****************************************/
cmulady 1:9ba884d85ac6 20
cmulady 13:17fd813ef7c9 21 //Function Prototypes
cmulady 13:17fd813ef7c9 22 void BlinkAlive(void const* arguments);
cmulady 13:17fd813ef7c9 23 void UpdateLCD(void const* arguments);
cmulady 13:17fd813ef7c9 24 void IRStuff(void const* arguments);
cmulady 13:17fd813ef7c9 25 void ISR_UARTRX(void);
cmulady 13:17fd813ef7c9 26 char CheckPacket(char new_data, char* packet_buffer, char* data, int data_len);
cmulady 13:17fd813ef7c9 27 void MakePacket2(char* data,int len);
cmulady 13:17fd813ef7c9 28
cmulady 3:8e492eacd346 29 //Pin Setup
cmulady 13:17fd813ef7c9 30 PwmOut led1(LED1);
cmulady 13:17fd813ef7c9 31 PwmOut led2(LED2);
cmulady 3:8e492eacd346 32 DigitalOut led3(LED3);
cmulady 3:8e492eacd346 33 DigitalOut led4(LED4);
cmulady 0:c8ddcaa575ba 34 NokiaLCD lcd(p5, p7, p8, p9, NokiaLCD::LCD6610); // mosi, sclk, cs, rst, type
cmulady 13:17fd813ef7c9 35 Serial* devicerx;
cmulady 13:17fd813ef7c9 36
cmulady 13:17fd813ef7c9 37 //Serial devicetx(p13,NC);
cmulady 6:5563f0026858 38 Serial pc(USBTX,USBRX);
cmulady 5:2e08cc167fff 39 PwmOut IRLED_mod(p21);
cmulady 1:9ba884d85ac6 40
cmulady 16:bc0e213ba52d 41 IRTransmitter ir_tx(p13,p21,p14,4,&ISR_UARTRX); //tx,pwm,size
cmulady 13:17fd813ef7c9 42
cmulady 3:8e492eacd346 43 //Global Vars
cmulady 12:9acca1dd0e8e 44 char text_buffer[32];
cmulady 6:5563f0026858 45 char irdatOUT[10];
cmulady 6:5563f0026858 46 char irdatIN[10];
cmulady 12:9acca1dd0e8e 47 char irdata_out=0;
cmulady 6:5563f0026858 48 char error_code=0;
cmulady 8:54dd4a3d0de9 49 Thread* threadptr_irstuff;
cmulady 9:3e4e9d6a8ad8 50 char packet_buff[10];
cmulady 10:4fcd5bdb9642 51 Mail<char,64> rx_data_mailbox;
cmulady 1:9ba884d85ac6 52
cmulady 13:17fd813ef7c9 53
cmulady 1:9ba884d85ac6 54
cmulady 1:9ba884d85ac6 55
cmulady 1:9ba884d85ac6 56 int main()
cmulady 1:9ba884d85ac6 57 {
cmulady 0:c8ddcaa575ba 58
cmulady 3:8e492eacd346 59 //LCD init
cmulady 0:c8ddcaa575ba 60 lcd.background(0x000000);
cmulady 1:9ba884d85ac6 61
cmulady 6:5563f0026858 62 //PC serial init
cmulady 6:5563f0026858 63 pc.baud(19200);
cmulady 7:c9ff6b5c8507 64 pc.printf("Starting...\n\n");
cmulady 6:5563f0026858 65
cmulady 16:bc0e213ba52d 66 //IR_TRX module
cmulady 16:bc0e213ba52d 67 ir_tx.set_debug_port(&pc);
cmulady 16:bc0e213ba52d 68
cmulady 13:17fd813ef7c9 69
cmulady 9:3e4e9d6a8ad8 70 //Variable Init
cmulady 9:3e4e9d6a8ad8 71 for(int i=0; i<10; i++) packet_buff[i]=0;
cmulady 9:3e4e9d6a8ad8 72
cmulady 12:9acca1dd0e8e 73 //Threads init
cmulady 1:9ba884d85ac6 74 Thread thread_blinkalive(BlinkAlive);
cmulady 1:9ba884d85ac6 75 Thread thread_updatelcd(UpdateLCD);
cmulady 3:8e492eacd346 76 Thread thread_irstuff(IRStuff);
cmulady 8:54dd4a3d0de9 77 threadptr_irstuff = &thread_irstuff;
cmulady 1:9ba884d85ac6 78
cmulady 1:9ba884d85ac6 79
cmulady 1:9ba884d85ac6 80
cmulady 0:c8ddcaa575ba 81 while(1) {
cmulady 13:17fd813ef7c9 82
cmulady 12:9acca1dd0e8e 83 //Use main loop to set LCD framerate
cmulady 1:9ba884d85ac6 84 thread_updatelcd.signal_set(0x1);
cmulady 1:9ba884d85ac6 85 Thread::wait(1000/FPS);
cmulady 1:9ba884d85ac6 86
cmulady 0:c8ddcaa575ba 87 }
cmulady 0:c8ddcaa575ba 88 }
cmulady 1:9ba884d85ac6 89
cmulady 1:9ba884d85ac6 90 void UpdateLCD(void const* arguments)
cmulady 1:9ba884d85ac6 91 {
cmulady 7:c9ff6b5c8507 92 while(true) {
cmulady 13:17fd813ef7c9 93
cmulady 12:9acca1dd0e8e 94 //Start flash LED
cmulady 13:17fd813ef7c9 95 led2 = 0.02;
cmulady 13:17fd813ef7c9 96
cmulady 12:9acca1dd0e8e 97 //Write debug text to screen
cmulady 1:9ba884d85ac6 98 lcd.locate(0,1);
cmulady 1:9ba884d85ac6 99 lcd.printf("Debug:");
cmulady 1:9ba884d85ac6 100 lcd.locate(0,3);
cmulady 1:9ba884d85ac6 101 time_t seconds = time(NULL);
cmulady 12:9acca1dd0e8e 102 strftime(text_buffer, 32, "%I:%M:%S %p\n", localtime(&seconds));
cmulady 12:9acca1dd0e8e 103 lcd.printf("%s", text_buffer);
cmulady 3:8e492eacd346 104 lcd.locate(0,4);
cmulady 6:5563f0026858 105 lcd.printf("IR_OUT=0x%02X,0x%02X", irdatOUT[0],irdatOUT[1]);
cmulady 3:8e492eacd346 106 lcd.locate(0,5);
cmulady 6:5563f0026858 107 lcd.printf("IR_IN= 0x%02X,0x%02X", irdatIN[0],irdatIN[1]);
cmulady 6:5563f0026858 108 lcd.locate(0,6);
cmulady 6:5563f0026858 109 lcd.printf("Error= 0x%02X", error_code);
cmulady 3:8e492eacd346 110
cmulady 12:9acca1dd0e8e 111 //End - flash LED
cmulady 13:17fd813ef7c9 112 led2 = 0.0;
cmulady 1:9ba884d85ac6 113 //End - Sleep thread
cmulady 1:9ba884d85ac6 114 Thread::signal_wait(0x1);
cmulady 7:c9ff6b5c8507 115 }
cmulady 1:9ba884d85ac6 116 }
cmulady 1:9ba884d85ac6 117
cmulady 3:8e492eacd346 118 void IRStuff(void const* arguments)
cmulady 3:8e492eacd346 119 {
cmulady 3:8e492eacd346 120 while(true) {
cmulady 7:c9ff6b5c8507 121
cmulady 12:9acca1dd0e8e 122 //If data available - Print data directly to USB port (for debug)
cmulady 15:21c512907cf6 123 /*osEvent evt = rx_data_mailbox.get();
cmulady 10:4fcd5bdb9642 124 while(evt.status == osEventMail) {
cmulady 10:4fcd5bdb9642 125 char* mail = (char*)evt.value.p;
cmulady 13:17fd813ef7c9 126 //if((*mail)==0x02) pc.printf("\n");
cmulady 13:17fd813ef7c9 127 //pc.printf("0x%02X.",*mail);
cmulady 13:17fd813ef7c9 128 error_code = CheckPacket(*mail,packet_buff,irdatIN,4);
cmulady 13:17fd813ef7c9 129 pc.printf(" ERROR=0x%02X.\n",error_code);
cmulady 13:17fd813ef7c9 130
cmulady 10:4fcd5bdb9642 131 rx_data_mailbox.free(mail);
cmulady 10:4fcd5bdb9642 132 evt = rx_data_mailbox.get();
cmulady 15:21c512907cf6 133 }*/
cmulady 15:21c512907cf6 134
cmulady 15:21c512907cf6 135 /*osEvent evt = ir_tx.ir_data_mailbox.get();
cmulady 15:21c512907cf6 136 while(evt.status == osEventMail) {
cmulady 15:21c512907cf6 137 char* mail = (char*)evt.value.p;
cmulady 15:21c512907cf6 138 //if((*mail)==0x02) pc.printf("\n");
cmulady 15:21c512907cf6 139 //pc.printf("0x%02X.",*mail);
cmulady 15:21c512907cf6 140 //error_code = CheckPacket(*mail,packet_buff,irdatIN,4);
cmulady 15:21c512907cf6 141 //pc.printf(" ERROR=0x%02X.\n",error_code);
cmulady 15:21c512907cf6 142
cmulady 15:21c512907cf6 143 ir_tx.ir_data_mailbox.free(mail);
cmulady 15:21c512907cf6 144 evt = ir_tx.ir_data_mailbox.get();
cmulady 15:21c512907cf6 145 }*/
cmulady 16:bc0e213ba52d 146
cmulady 16:bc0e213ba52d 147 char result;
cmulady 16:bc0e213ba52d 148 result = ir_tx.ReadPacket(irdatIN,4);
cmulady 16:bc0e213ba52d 149 if(result == 0x1) {
cmulady 16:bc0e213ba52d 150 pc.printf("\n");
cmulady 16:bc0e213ba52d 151 for(int i=0; i<4; i++) {
cmulady 16:bc0e213ba52d 152 pc.printf("0x%02X.",irdatIN[i]);
cmulady 16:bc0e213ba52d 153 }
cmulady 16:bc0e213ba52d 154 }
cmulady 16:bc0e213ba52d 155
cmulady 15:21c512907cf6 156
cmulady 13:17fd813ef7c9 157
cmulady 12:9acca1dd0e8e 158 //Do not return until we have more data
cmulady 13:17fd813ef7c9 159 //Thread::signal_wait(0x1);
cmulady 16:bc0e213ba52d 160 Thread::wait(10);
cmulady 3:8e492eacd346 161 }
cmulady 4:8fdff78c13c8 162
cmulady 3:8e492eacd346 163 }
cmulady 3:8e492eacd346 164
cmulady 13:17fd813ef7c9 165 char CheckPacket(char new_data, char* packet_buffer, char* data, int data_len)
cmulady 6:5563f0026858 166 {
cmulady 13:17fd813ef7c9 167 //Requires a packet buffer of length 'data_len'+3.
cmulady 9:3e4e9d6a8ad8 168 //Shifts data and checks each 'set' for a valid packet.
cmulady 9:3e4e9d6a8ad8 169 //Once a valid packet is receievd, the data buffer is updated with new values.
cmulady 13:17fd813ef7c9 170 //returns success(0) or failure(error code)
cmulady 13:17fd813ef7c9 171
cmulady 9:3e4e9d6a8ad8 172
cmulady 9:3e4e9d6a8ad8 173 char check=0x0;
cmulady 9:3e4e9d6a8ad8 174 //Shift All data 1 cell over
cmulady 13:17fd813ef7c9 175 for(int i=0; i<data_len+2; i++) {
cmulady 9:3e4e9d6a8ad8 176 packet_buffer[i] = packet_buffer[i+1];
cmulady 9:3e4e9d6a8ad8 177 }
cmulady 13:17fd813ef7c9 178 packet_buffer[data_len+2] = new_data;
cmulady 9:3e4e9d6a8ad8 179
cmulady 9:3e4e9d6a8ad8 180 //check for valid packet
cmulady 13:17fd813ef7c9 181 if(packet_buffer[0]!=ASCII_STX)
cmulady 9:3e4e9d6a8ad8 182 return 0x1; //bad start byte
cmulady 13:17fd813ef7c9 183 if(packet_buffer[data_len+2]!=ASCII_ETX)
cmulady 13:17fd813ef7c9 184 return 0x2; //bad end byte
cmulady 9:3e4e9d6a8ad8 185
cmulady 9:3e4e9d6a8ad8 186 for(int i=1; i<data_len+1; i++) {
cmulady 9:3e4e9d6a8ad8 187 check^=packet_buffer[i];
cmulady 9:3e4e9d6a8ad8 188 }
cmulady 15:21c512907cf6 189 if(check!=packet_buffer[data_len+1]) {
cmulady 15:21c512907cf6 190 return 0x3; //bad checksum
cmulady 9:3e4e9d6a8ad8 191 }
cmulady 13:17fd813ef7c9 192
cmulady 9:3e4e9d6a8ad8 193 return 0;
cmulady 9:3e4e9d6a8ad8 194 }
cmulady 9:3e4e9d6a8ad8 195
cmulady 13:17fd813ef7c9 196 void BlinkAlive(void const* arguments)
cmulady 13:17fd813ef7c9 197 {
cmulady 13:17fd813ef7c9 198 while(true) {
cmulady 13:17fd813ef7c9 199
cmulady 13:17fd813ef7c9 200 //Change LED1 state (debug)
cmulady 13:17fd813ef7c9 201 (led1==0.0)?led1=0.02:led1=0.0;
cmulady 13:17fd813ef7c9 202
cmulady 13:17fd813ef7c9 203 //Form a test packet and send it over IR transmitter
cmulady 13:17fd813ef7c9 204 irdatOUT[0] = 0xA5;
cmulady 13:17fd813ef7c9 205 irdatOUT[1] = ++irdata_out;
cmulady 13:17fd813ef7c9 206 irdatOUT[2] = ~(irdata_out*2);
cmulady 13:17fd813ef7c9 207 irdatOUT[3] = irdata_out*7+13;
cmulady 13:17fd813ef7c9 208 //MakePacket2(irdatOUT,4);
cmulady 16:bc0e213ba52d 209 ir_tx.MakePacket(irdatOUT,4);
cmulady 13:17fd813ef7c9 210
cmulady 13:17fd813ef7c9 211 //Roughly use to set rate of data packets per second
cmulady 16:bc0e213ba52d 212 Thread::wait(200);
cmulady 13:17fd813ef7c9 213 }
cmulady 13:17fd813ef7c9 214 }
cmulady 13:17fd813ef7c9 215
cmulady 13:17fd813ef7c9 216 void MakePacket2(char* data,int len)
cmulady 13:17fd813ef7c9 217 {
cmulady 13:17fd813ef7c9 218 /*char check =0x0;
cmulady 13:17fd813ef7c9 219 (*devicerx).putc(ASCII_STX);
cmulady 13:17fd813ef7c9 220 for(int i=0; i<len; i++) {
cmulady 13:17fd813ef7c9 221 check^=data[i];
cmulady 13:17fd813ef7c9 222 (*devicerx).putc(data[i]);
cmulady 13:17fd813ef7c9 223 }
cmulady 13:17fd813ef7c9 224 (*devicerx).putc(check);
cmulady 13:17fd813ef7c9 225 (*devicerx).putc(ASCII_ETX);*/
cmulady 13:17fd813ef7c9 226 }
cmulady 13:17fd813ef7c9 227
cmulady 13:17fd813ef7c9 228
cmulady 13:17fd813ef7c9 229
cmulady 12:9acca1dd0e8e 230 //Handle Reception of RX data (mail it to appropriate thread)
cmulady 14:68f7cefd7359 231 void ISR_UARTRX()
cmulady 7:c9ff6b5c8507 232 {
cmulady 12:9acca1dd0e8e 233 //get RX data (and prevent ISR from looping forever
cmulady 7:c9ff6b5c8507 234 uint32_t RBR = LPC_UART1->RBR;
cmulady 9:3e4e9d6a8ad8 235
cmulady 12:9acca1dd0e8e 236 //write letter and put in mailbox
cmulady 15:21c512907cf6 237 /*char* mail = rx_data_mailbox.alloc();
cmulady 10:4fcd5bdb9642 238 mail[0] = (char)RBR;
cmulady 15:21c512907cf6 239 rx_data_mailbox.put(mail);*/
cmulady 15:21c512907cf6 240
cmulady 15:21c512907cf6 241 /*char* mail = ir_tx.ir_data_mailbox.alloc();
cmulady 15:21c512907cf6 242 mail[0] = (char)RBR;
cmulady 15:21c512907cf6 243 ir_tx.ir_data_mailbox.put(mail);*/
cmulady 16:bc0e213ba52d 244
cmulady 16:bc0e213ba52d 245 ir_tx.isr(RBR);
cmulady 10:4fcd5bdb9642 246
cmulady 12:9acca1dd0e8e 247 //Let message handler run
cmulady 15:21c512907cf6 248 //(*threadptr_irstuff).signal_set(0x1);
cmulady 8:54dd4a3d0de9 249
cmulady 7:c9ff6b5c8507 250 }
cmulady 7:c9ff6b5c8507 251