Tick Tock / Mbed 2 deprecated CANary_9341

Dual CANbus monitor and instrumentation cluster supporting ILI9341 display controller

Dependencies:   SPI_TFTx2_ILI9341 TOUCH_TFTx2_ILI9341 TFT_fonts mbed

Fork of CANary by Tick Tock

utility.cpp@23:cd03f9c3395e, 2013-03-14 (annotated)

Committer:
TickTock
Date:
Thu Mar 14 04:41:11 2013 +0000
Revision:
23:cd03f9c3395e
Parent:
22:a43df3905863
Child:
25:ddf0ec209f03
Added logging enable/disable, touch calibration, reset, config save

Who changed what in which revision?

UserRevisionLine numberNew 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 22:a43df3905863 6
TickTock 13:62e0f7f39ff5 7 void RTC_IRQHandler() {
TickTock 13:62e0f7f39ff5 8 timer.reset(); // zero ms at the-seconds-tic
TickTock 20:3bf176d14b14 9 canIdle=(++secsNoMsg>canTimeout)?true:false;
TickTock 20:3bf176d14b14 10 userIdle=(++secsNoTouch>userTimeout)?true:false;
TickTock 13:62e0f7f39ff5 11 LPC_RTC->ILR |= (1<<0); // clear interrupt to prepare for next
TickTock 13:62e0f7f39ff5 12 }
TickTock 13:62e0f7f39ff5 13
TickTock 13:62e0f7f39ff5 14 extern "C" void RTC_Init (void) {
TickTock 13:62e0f7f39ff5 15 LPC_RTC->ILR=0x00; // set up the RTC interrupts
TickTock 13:62e0f7f39ff5 16 LPC_RTC->CIIR=0x01; // interrupts each second
TickTock 13:62e0f7f39ff5 17 LPC_RTC->CCR = 0x01; // Clock enable
TickTock 13:62e0f7f39ff5 18 //NVIC_SetPriority( RTC_IRQn, 10 );
TickTock 13:62e0f7f39ff5 19 NVIC_EnableIRQ( RTC_IRQn );
TickTock 13:62e0f7f39ff5 20 }
TickTock 13:62e0f7f39ff5 21
TickTock 13:62e0f7f39ff5 22 void logMsg (char *msg) {
TickTock 13:62e0f7f39ff5 23 strcpy(displayLog[displayLoc],msg);
TickTock 13:62e0f7f39ff5 24 displayLoc=displayLoc>17?0:displayLoc+1;
TickTock 13:62e0f7f39ff5 25 }
TickTock 13:62e0f7f39ff5 26
TickTock 13:62e0f7f39ff5 27 void touch_ISR(){
TickTock 13:62e0f7f39ff5 28 LPC_GPIOINT->IO2IntClr = (LPC_GPIOINT->IO2IntStatR | LPC_GPIOINT->IO2IntStatF);
TickTock 22:a43df3905863 29 touched=true; // jsut set flag - touch screen algorythm is long and we don't want to block other interrupts
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 23:cd03f9c3395e 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 23:cd03f9c3395e 133 for(i=0;i<29;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 23:cd03f9c3395e 150 for(i=0;i<3;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
TickTock 22:a43df3905863 178 unsigned char buttonX(unsigned short X, unsigned char columns) {
TickTock 22:a43df3905863 179 unsigned char val = X*columns/320;
TickTock 22:a43df3905863 180 return val;
TickTock 22:a43df3905863 181 }
TickTock 22:a43df3905863 182
TickTock 22:a43df3905863 183 unsigned char buttonY(unsigned short Y, unsigned char rows) {
TickTock 22:a43df3905863 184 unsigned short val = Y*rows/240;
TickTock 22:a43df3905863 185 return val;
TickTock 22:a43df3905863 186 }
TickTock 23:cd03f9c3395e 187
TickTock 23:cd03f9c3395e 188 void saveConfig(){
TickTock 23:cd03f9c3395e 189 FILE *cfile;
TickTock 23:cd03f9c3395e 190 cfile = fopen("/local/config.txt", "w");
TickTock 23:cd03f9c3395e 191 fprintf(cfile,"format 1\r\n");
TickTock 23:cd03f9c3395e 192 fprintf(cfile,"x0_off %d\r\n",tt.x0_off);
TickTock 23:cd03f9c3395e 193 fprintf(cfile,"y0_off %d\r\n",tt.y0_off);
TickTock 23:cd03f9c3395e 194 fprintf(cfile,"x0_pp %d\r\n",tt.x0_pp);
TickTock 23:cd03f9c3395e 195 fprintf(cfile,"y0_pp %d\r\n",tt.y0_pp);
TickTock 23:cd03f9c3395e 196 fprintf(cfile,"x1_off %d\r\n",tt.x1_off);
TickTock 23:cd03f9c3395e 197 fprintf(cfile,"y1_off %d\r\n",tt.y1_off);
TickTock 23:cd03f9c3395e 198 fprintf(cfile,"x1_pp %d\r\n",tt.x1_pp);
TickTock 23:cd03f9c3395e 199 fprintf(cfile,"y1_pp %d\r\n",tt.y1_pp);
TickTock 23:cd03f9c3395e 200 fprintf(cfile,"x_mid %d\r\n",tt.x_mid);
TickTock 23:cd03f9c3395e 201 fclose(cfile);
TickTock 23:cd03f9c3395e 202 }
TickTock 23:cd03f9c3395e 203
TickTock 23:cd03f9c3395e 204 void readConfig(){
TickTock 23:cd03f9c3395e 205 FILE *cfile;
TickTock 23:cd03f9c3395e 206 int ff;
TickTock 23:cd03f9c3395e 207 char sTemp[40];
TickTock 23:cd03f9c3395e 208 cfile = fopen("/local/config.txt", "r");
TickTock 23:cd03f9c3395e 209 if (cfile==NULL){ // if doesn't exist --> create
TickTock 23:cd03f9c3395e 210 sprintf(sTemp,"No config file found.\n");
TickTock 23:cd03f9c3395e 211 logMsg(sTemp);
TickTock 23:cd03f9c3395e 212 sprintf(sTemp,"Calibrating touch screen.\n");
TickTock 23:cd03f9c3395e 213 logMsg(sTemp);
TickTock 23:cd03f9c3395e 214 //tt.setcal(5570, 34030, 80, 108, 33700, 5780, 82, 108, 32500);// bypass calibration using my values
TickTock 23:cd03f9c3395e 215 tt.calibrate(); // run touchscreen calibration routine
TickTock 23:cd03f9c3395e 216 saveConfig();
TickTock 23:cd03f9c3395e 217 } else {
TickTock 23:cd03f9c3395e 218 sprintf(sTemp,"Reading config file.\n");
TickTock 23:cd03f9c3395e 219 logMsg(sTemp);
TickTock 23:cd03f9c3395e 220 //tt.setcal(5570, 34030, 80, 108, 33700, 5780, 82, 108, 32500);// bypass calibration using my values
TickTock 23:cd03f9c3395e 221 fscanf(cfile, "format %c\r\n", &ff ) ;
TickTock 23:cd03f9c3395e 222 fscanf(cfile, "x0_off %d\r\n", &tt.x0_off ) ;
TickTock 23:cd03f9c3395e 223 fscanf(cfile, "y0_off %d\r\n", &tt.y0_off ) ;
TickTock 23:cd03f9c3395e 224 fscanf(cfile, "x0_pp %d\r\n", &tt.x0_pp ) ;
TickTock 23:cd03f9c3395e 225 fscanf(cfile, "y0_pp %d\r\n", &tt.y0_pp ) ;
TickTock 23:cd03f9c3395e 226 fscanf(cfile, "x1_off %d\r\n", &tt.x1_off ) ;
TickTock 23:cd03f9c3395e 227 fscanf(cfile, "y1_off %d\r\n", &tt.y1_off ) ;
TickTock 23:cd03f9c3395e 228 fscanf(cfile, "x1_pp %d\r\n", &tt.x1_pp ) ;
TickTock 23:cd03f9c3395e 229 fscanf(cfile, "y1_pp %d\r\n", &tt.y1_pp ) ;
TickTock 23:cd03f9c3395e 230 fscanf(cfile, "x_mid %d\r\n", &tt.x_mid ) ;
TickTock 23:cd03f9c3395e 231 fclose(cfile);
TickTock 23:cd03f9c3395e 232 }
TickTock 23:cd03f9c3395e 233 }