Dual CANbus monitor and instrumentation cluster
Dependencies: SPI_TFTx2 TFT_fonts TOUCH_TFTx2 beep mbed
Fork of CANary by
utility.cpp@13:62e0f7f39ff5, 2013-03-03 (annotated)
- Committer:
- TickTock
- Date:
- Sun Mar 03 17:06:12 2013 +0000
- Revision:
- 13:62e0f7f39ff5
- Child:
- 20:3bf176d14b14
More partitioning
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
TickTock | 13:62e0f7f39ff5 | 1 | // utility.cpp |
TickTock | 13:62e0f7f39ff5 | 2 | |
TickTock | 13:62e0f7f39ff5 | 3 | #include "utility.h" |
TickTock | 13:62e0f7f39ff5 | 4 | |
TickTock | 13:62e0f7f39ff5 | 5 | void mbed_reset(); |
TickTock | 13:62e0f7f39ff5 | 6 | void RTC_IRQHandler() { |
TickTock | 13:62e0f7f39ff5 | 7 | timer.reset(); // zero ms at the-seconds-tic |
TickTock | 13:62e0f7f39ff5 | 8 | canIdle=(++secsNoMsg>canTimeout); |
TickTock | 13:62e0f7f39ff5 | 9 | userIdle=(++secsNoTouch>userTimeout); |
TickTock | 13:62e0f7f39ff5 | 10 | LPC_RTC->ILR |= (1<<0); // clear interrupt to prepare for next |
TickTock | 13:62e0f7f39ff5 | 11 | } |
TickTock | 13:62e0f7f39ff5 | 12 | |
TickTock | 13:62e0f7f39ff5 | 13 | extern "C" void RTC_Init (void) { |
TickTock | 13:62e0f7f39ff5 | 14 | LPC_RTC->ILR=0x00; // set up the RTC interrupts |
TickTock | 13:62e0f7f39ff5 | 15 | LPC_RTC->CIIR=0x01; // interrupts each second |
TickTock | 13:62e0f7f39ff5 | 16 | LPC_RTC->CCR = 0x01; // Clock enable |
TickTock | 13:62e0f7f39ff5 | 17 | //NVIC_SetPriority( RTC_IRQn, 10 ); |
TickTock | 13:62e0f7f39ff5 | 18 | NVIC_EnableIRQ( RTC_IRQn ); |
TickTock | 13:62e0f7f39ff5 | 19 | } |
TickTock | 13:62e0f7f39ff5 | 20 | |
TickTock | 13:62e0f7f39ff5 | 21 | void logMsg (char *msg) { |
TickTock | 13:62e0f7f39ff5 | 22 | strcpy(displayLog[displayLoc],msg); |
TickTock | 13:62e0f7f39ff5 | 23 | displayLoc=displayLoc>17?0:displayLoc+1; |
TickTock | 13:62e0f7f39ff5 | 24 | } |
TickTock | 13:62e0f7f39ff5 | 25 | |
TickTock | 13:62e0f7f39ff5 | 26 | void touch_ISR(){ |
TickTock | 13:62e0f7f39ff5 | 27 | LPC_GPIOINT->IO2IntClr = (LPC_GPIOINT->IO2IntStatR | LPC_GPIOINT->IO2IntStatF); |
TickTock | 13:62e0f7f39ff5 | 28 | secsNoTouch = 0; |
TickTock | 13:62e0f7f39ff5 | 29 | touched=true; |
TickTock | 13:62e0f7f39ff5 | 30 | } |
TickTock | 13:62e0f7f39ff5 | 31 | |
TickTock | 13:62e0f7f39ff5 | 32 | unsigned short getTimeStamp() { |
TickTock | 13:62e0f7f39ff5 | 33 | unsigned short msec = timer.read_ms() ; // read ms from the timer |
TickTock | 13:62e0f7f39ff5 | 34 | unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900 |
TickTock | 13:62e0f7f39ff5 | 35 | unsigned short isecs = secs%60 ; // modulo 60 for 0-59 seconds from RTC |
TickTock | 13:62e0f7f39ff5 | 36 | return ((isecs<<10)+msec) ; // return the two byte time stamp |
TickTock | 13:62e0f7f39ff5 | 37 | } |
TickTock | 13:62e0f7f39ff5 | 38 | |
TickTock | 13:62e0f7f39ff5 | 39 | void logCan (char mType, CANMessage canRXmsg) { |
TickTock | 13:62e0f7f39ff5 | 40 | char sTemp[40]; |
TickTock | 13:62e0f7f39ff5 | 41 | unsigned short ts = getTimeStamp(); |
TickTock | 13:62e0f7f39ff5 | 42 | unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900 |
TickTock | 13:62e0f7f39ff5 | 43 | static unsigned char ii = 0, lasti = 0; // indexindex |
TickTock | 13:62e0f7f39ff5 | 44 | unsigned char changed,i; |
TickTock | 13:62e0f7f39ff5 | 45 | static unsigned char bdi; |
TickTock | 13:62e0f7f39ff5 | 46 | if(logOpen){ |
TickTock | 13:62e0f7f39ff5 | 47 | if(canRXmsg.id>0) { |
TickTock | 13:62e0f7f39ff5 | 48 | writeBuffer[writePointer][0]=mType; |
TickTock | 13:62e0f7f39ff5 | 49 | writeBuffer[writePointer][1]=((secs%60)<<2)+((ts&0x300)>>8); |
TickTock | 13:62e0f7f39ff5 | 50 | writeBuffer[writePointer][2]=ts&0xff; |
TickTock | 13:62e0f7f39ff5 | 51 | writeBuffer[writePointer][3]=canRXmsg.id&0xff; |
TickTock | 13:62e0f7f39ff5 | 52 | writeBuffer[writePointer][4]=(canRXmsg.id>>8)+(canRXmsg.len<<4); |
TickTock | 13:62e0f7f39ff5 | 53 | for(i=5;i<13;i++){ |
TickTock | 13:62e0f7f39ff5 | 54 | writeBuffer[writePointer][i]=canRXmsg.data[i-5]; |
TickTock | 13:62e0f7f39ff5 | 55 | } |
TickTock | 13:62e0f7f39ff5 | 56 | if (++writePointer >= maxBufLen) { |
TickTock | 13:62e0f7f39ff5 | 57 | writePointer = 0; |
TickTock | 13:62e0f7f39ff5 | 58 | led3 = !led3; |
TickTock | 13:62e0f7f39ff5 | 59 | } |
TickTock | 13:62e0f7f39ff5 | 60 | } |
TickTock | 13:62e0f7f39ff5 | 61 | }//if logOpen |
TickTock | 13:62e0f7f39ff5 | 62 | if(indexLastMsg[canRXmsg.id]==0) { //Check if no entry |
TickTock | 13:62e0f7f39ff5 | 63 | ii=ii<99?ii+1:0; |
TickTock | 13:62e0f7f39ff5 | 64 | indexLastMsg[canRXmsg.id]=ii; //Create entry if first message |
TickTock | 13:62e0f7f39ff5 | 65 | } |
TickTock | 13:62e0f7f39ff5 | 66 | if(dMode[0]==changedScreen||dMode[1]==changedScreen){ |
TickTock | 13:62e0f7f39ff5 | 67 | changed=msgChanged[indexLastMsg[canRXmsg.id]]; |
TickTock | 13:62e0f7f39ff5 | 68 | for(i=0;i<8;i++){ |
TickTock | 13:62e0f7f39ff5 | 69 | if(lastMsg[indexLastMsg[canRXmsg.id]].data[i]!=canRXmsg.data[i]){ |
TickTock | 13:62e0f7f39ff5 | 70 | changed |= 1<<i; |
TickTock | 13:62e0f7f39ff5 | 71 | } |
TickTock | 13:62e0f7f39ff5 | 72 | } |
TickTock | 13:62e0f7f39ff5 | 73 | msgChanged[indexLastMsg[canRXmsg.id]]=changed; |
TickTock | 13:62e0f7f39ff5 | 74 | } |
TickTock | 13:62e0f7f39ff5 | 75 | lastMsg[indexLastMsg[canRXmsg.id]]=canRXmsg; //Store in table |
TickTock | 13:62e0f7f39ff5 | 76 | if(mType==1&&canRXmsg.id==0x7bb){ // is battery data? Need to store all responses |
TickTock | 13:62e0f7f39ff5 | 77 | if(canRXmsg.data[0]<0x20){ |
TickTock | 13:62e0f7f39ff5 | 78 | if(canRXmsg.data[3]==2){//cellpair data |
TickTock | 13:62e0f7f39ff5 | 79 | bdi=0; |
TickTock | 13:62e0f7f39ff5 | 80 | sprintf(sTemp,"Getting cell pair data\n"); |
TickTock | 13:62e0f7f39ff5 | 81 | logMsg(sTemp); |
TickTock | 13:62e0f7f39ff5 | 82 | }else if(canRXmsg.data[3]==4){//temperature data |
TickTock | 13:62e0f7f39ff5 | 83 | bdi=0x20; |
TickTock | 13:62e0f7f39ff5 | 84 | sprintf(sTemp,"Getting temperature data\n"); |
TickTock | 13:62e0f7f39ff5 | 85 | logMsg(sTemp); |
TickTock | 13:62e0f7f39ff5 | 86 | }else bdi=0; |
TickTock | 13:62e0f7f39ff5 | 87 | lasti=0; |
TickTock | 13:62e0f7f39ff5 | 88 | } |
TickTock | 13:62e0f7f39ff5 | 89 | i=canRXmsg.data[0]&0x0f; //lower nibble of D0 is index |
TickTock | 13:62e0f7f39ff5 | 90 | if(lasti>i){ //detect rolloever and offset index appropriately |
TickTock | 13:62e0f7f39ff5 | 91 | bdi=0x10; |
TickTock | 13:62e0f7f39ff5 | 92 | } |
TickTock | 13:62e0f7f39ff5 | 93 | lasti=i; //remember the msb to detect rollover next time around |
TickTock | 13:62e0f7f39ff5 | 94 | i+=bdi; |
TickTock | 13:62e0f7f39ff5 | 95 | i*=7; |
TickTock | 13:62e0f7f39ff5 | 96 | if(i<0xfa){ |
TickTock | 13:62e0f7f39ff5 | 97 | battData[i+0]=canRXmsg.data[1]; |
TickTock | 13:62e0f7f39ff5 | 98 | battData[i+1]=canRXmsg.data[2]; |
TickTock | 13:62e0f7f39ff5 | 99 | battData[i+2]=canRXmsg.data[3]; |
TickTock | 13:62e0f7f39ff5 | 100 | battData[i+3]=canRXmsg.data[4]; |
TickTock | 13:62e0f7f39ff5 | 101 | battData[i+4]=canRXmsg.data[5]; |
TickTock | 13:62e0f7f39ff5 | 102 | battData[i+5]=canRXmsg.data[6]; |
TickTock | 13:62e0f7f39ff5 | 103 | battData[i+6]=canRXmsg.data[7]; |
TickTock | 13:62e0f7f39ff5 | 104 | } |
TickTock | 13:62e0f7f39ff5 | 105 | }//if 0x7bb |
TickTock | 13:62e0f7f39ff5 | 106 | } |
TickTock | 13:62e0f7f39ff5 | 107 | |
TickTock | 13:62e0f7f39ff5 | 108 | void logTS () { |
TickTock | 13:62e0f7f39ff5 | 109 | CANMessage tsMsg; |
TickTock | 13:62e0f7f39ff5 | 110 | unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900 |
TickTock | 13:62e0f7f39ff5 | 111 | tsMsg.id=0xfff; |
TickTock | 13:62e0f7f39ff5 | 112 | tsMsg.len=0xf; |
TickTock | 13:62e0f7f39ff5 | 113 | tsMsg.data[0]=secs&0xff; |
TickTock | 13:62e0f7f39ff5 | 114 | tsMsg.data[1]=(secs>>8)&0xff; |
TickTock | 13:62e0f7f39ff5 | 115 | tsMsg.data[2]=(secs>>16)&0xff; |
TickTock | 13:62e0f7f39ff5 | 116 | tsMsg.data[3]=secs>>24; |
TickTock | 13:62e0f7f39ff5 | 117 | tsMsg.data[4]=0xff; |
TickTock | 13:62e0f7f39ff5 | 118 | tsMsg.data[5]=0xff; |
TickTock | 13:62e0f7f39ff5 | 119 | tsMsg.data[6]=0xff; |
TickTock | 13:62e0f7f39ff5 | 120 | tsMsg.data[7]=0xff; |
TickTock | 13:62e0f7f39ff5 | 121 | logCan(0,tsMsg); |
TickTock | 13:62e0f7f39ff5 | 122 | } |
TickTock | 13:62e0f7f39ff5 | 123 | |
TickTock | 13:62e0f7f39ff5 | 124 | void sendCPreq() { |
TickTock | 13:62e0f7f39ff5 | 125 | char i; |
TickTock | 13:62e0f7f39ff5 | 126 | char data[8] = {0x02, 0x21, 0x02, 0xff, 0xff, 0xff, 0xff, 0xff}; |
TickTock | 13:62e0f7f39ff5 | 127 | can1.monitor(false); // set to active mode |
TickTock | 13:62e0f7f39ff5 | 128 | can1SleepMode = 0; // enable TX |
TickTock | 13:62e0f7f39ff5 | 129 | can1.write(CANMessage(0x79b, data, 8)); |
TickTock | 13:62e0f7f39ff5 | 130 | data[0]=0x30; //change to request next line message |
TickTock | 13:62e0f7f39ff5 | 131 | data[1]=0x01; |
TickTock | 13:62e0f7f39ff5 | 132 | data[2]=0x00; |
TickTock | 13:62e0f7f39ff5 | 133 | for(i=0;i<27;i++){ |
TickTock | 13:62e0f7f39ff5 | 134 | wait_ms(16); //wait 16ms |
TickTock | 13:62e0f7f39ff5 | 135 | can1.write(CANMessage(0x79b, data, 8)); |
TickTock | 13:62e0f7f39ff5 | 136 | } |
TickTock | 13:62e0f7f39ff5 | 137 | can1SleepMode = 1; // disable TX |
TickTock | 13:62e0f7f39ff5 | 138 | can1.monitor(true); // set to snoop mode |
TickTock | 13:62e0f7f39ff5 | 139 | } |
TickTock | 13:62e0f7f39ff5 | 140 | |
TickTock | 13:62e0f7f39ff5 | 141 | void sendTreq() { |
TickTock | 13:62e0f7f39ff5 | 142 | char i; |
TickTock | 13:62e0f7f39ff5 | 143 | char data[8] = {0x02, 0x21, 0x04, 0xff, 0xff, 0xff, 0xff, 0xff}; |
TickTock | 13:62e0f7f39ff5 | 144 | can1.monitor(false); // set to active mode |
TickTock | 13:62e0f7f39ff5 | 145 | can1SleepMode = 0; // enable TX |
TickTock | 13:62e0f7f39ff5 | 146 | can1.write(CANMessage(0x79b, data, 8)); |
TickTock | 13:62e0f7f39ff5 | 147 | data[0]=0x30; //change to request next line message |
TickTock | 13:62e0f7f39ff5 | 148 | data[1]=0x01; |
TickTock | 13:62e0f7f39ff5 | 149 | data[2]=0x00; |
TickTock | 13:62e0f7f39ff5 | 150 | for(i=0;i<2;i++){ |
TickTock | 13:62e0f7f39ff5 | 151 | wait_ms(16); //wait 16ms |
TickTock | 13:62e0f7f39ff5 | 152 | can1.write(CANMessage(0x79b, data, 8)); |
TickTock | 13:62e0f7f39ff5 | 153 | } |
TickTock | 13:62e0f7f39ff5 | 154 | can1SleepMode = 1; // disable TX |
TickTock | 13:62e0f7f39ff5 | 155 | can1.monitor(true); // set to snoop mode |
TickTock | 13:62e0f7f39ff5 | 156 | } |
TickTock | 13:62e0f7f39ff5 | 157 | |
TickTock | 13:62e0f7f39ff5 | 158 | void tickerISR() { //This is the ticker ISR for auto-polling |
TickTock | 13:62e0f7f39ff5 | 159 | pollCP=true; //Set a flag to do in main loop instead of here |
TickTock | 13:62e0f7f39ff5 | 160 | } //since ticker blocks other interrupts |
TickTock | 13:62e0f7f39ff5 | 161 | |
TickTock | 13:62e0f7f39ff5 | 162 | void recieve1() { |
TickTock | 13:62e0f7f39ff5 | 163 | CANMessage msg1; |
TickTock | 13:62e0f7f39ff5 | 164 | secsNoMsg=0; // reset deadman switch |
TickTock | 13:62e0f7f39ff5 | 165 | can1.read(msg1); |
TickTock | 13:62e0f7f39ff5 | 166 | logCan(1, msg1); |
TickTock | 13:62e0f7f39ff5 | 167 | led1 = !led1; |
TickTock | 13:62e0f7f39ff5 | 168 | } |
TickTock | 13:62e0f7f39ff5 | 169 | |
TickTock | 13:62e0f7f39ff5 | 170 | void recieve2() { |
TickTock | 13:62e0f7f39ff5 | 171 | CANMessage msg2; |
TickTock | 13:62e0f7f39ff5 | 172 | secsNoMsg=0; // reset deadman switch |
TickTock | 13:62e0f7f39ff5 | 173 | can2.read(msg2); |
TickTock | 13:62e0f7f39ff5 | 174 | logCan(2, msg2); |
TickTock | 13:62e0f7f39ff5 | 175 | led2 = !led2; |
TickTock | 13:62e0f7f39ff5 | 176 | } |
TickTock | 13:62e0f7f39ff5 | 177 |