.
Dependencies: SDHCFileSystem mbed
main.cpp
- Committer:
- TickTock
- Date:
- 2012-12-05
- Revision:
- 10:663bff0a6144
- Parent:
- 9:8396b76e42fc
- Child:
- 11:d97071bf877b
File content as of revision 10:663bff0a6144:
//CANcan.cpp //A dual canbus monitoring "blackbox" application for the Nissan Leaf //Dumps all messages to a file on the SDRAM //Todo: // bigger buffer to avoid overflow (or messge filtering - ignore 174?) // // Connections: //LEAF OBD //1: //2: //3: AVCAN-L White/Blue //4: //5: VSS Brown,White/Brown //6: CARCAN-H Green --> VP230b:7 //7: //8: 12V-SW Orange,White/Orange //9: //10: //11: AVCAN-H Blue //12: EVCAN-L White/Grey --> VP230a:6 //13: EVCAN-H Grey --> VP230a:7 //14: CARCAN-L White/Green --> VP230b:6 //15: 6V //16: 12V-AON Red/Blue,Blue/Red ----|<---- LPC1768:2 //note 1: pins 4 & 5 longer //note 2: pins 12 & 13 next to key //note 3: pins 1 & 9 on right side looking into male connector with key on bottom //VP230{a,b} //1:D //2:GND //3:VCC //4:R //5:Vref //6:CANL --> OBD:12,14 //7:CANH --> OBD:13,6 //8:RS --> LPC1768:27,28 //LPC1768 //1: VSS 6V //2: VIN (4.5-9V supply) ---->|---- OBD:16 //3: NC:VB //4: NC:nR //5: SPI:MOSI --> 6:SDRAM:DI //6: SPI:MISO --> 2:SDRAM:DO //7: SPI:SCLK --> 4:SDRAM:SCLK //8: CS --> 7:SDRAM:CS //9: CAN1:RX --> 4:CAN1:R //10: CAN1:TX --> 1:CAN1:D //11: NC:RS --> 4:LCD:RS //12: NC:E --> 6:LCD:E //13: NC:D4 --> 11:LCD:D4 //14: NC:D5 --> 12:LCD:D5 //15: NC:D6 --> 13:LCD:D6 //16: NC:D7 --> 14:LCD:D7 //17: CD --> 1:SDRAM:CD //18: NC:MON12V --> 4K to 12V, 1K to VSS (To be implemented) //19: PB2 //20: PB1 //21: NC:Spkr+ //22: NC:Spkr- (optional complimentary output for more volume) //23: NC:pwm //24: NC:LEDBLU --> 18:LCD:BLU (only used for tri-color displays) //25: NC:LEDGRN --> 17:LCD:GRN (only used for tri-color displays) //26: NC:LEDRED --> 16:LCD:RED //27: CAN1:Sleep --> 8:CAN1:RS //28: CAN2:Sleep --> 8:CAN2:RS //29: CAN2:TX --> 1:CAN2:D //30: CAN2:RX --> 4:CAN2:R //31: NC:USB_D+ //32: NC:USB_D- //33: NC:Eth_TD+ //34: NC:Eth_TD- //35: NC:Eth_RD+ //36: NC:Eth_RD- //37: NC:IF+ //38: NC:IF- //39: NC:5Vout (only available when connected as USB device) //40: VCC3.3 #include "mbed.h" #include "CAN.h" #include "SDHCFileSystem.h" #define upLine "\033[1A" #define maxBufLen 2048 #define canTimeout 5 void Log (char *message); void LogErr (char *message); extern "C" void mbed_reset(); time_t seconds ; DigitalIn CD(p17); DigitalIn PB1( p20 ); SDFileSystem sd(p5, p6, p7, p8, "sd" ); // SDFileSystem::SDFileSystem(PinName mosi, PinName miso, PinName sclk, PinName cs, const char* name) Timer timer; DigitalOut led1(LED1); DigitalOut led2(LED2); DigitalOut led3(LED3); DigitalOut led4(LED4); CAN can1(p9, p10); // CAN1 uses pins 9 and 10 (rx, tx) and pin 27 (rs) DigitalOut can1_SleepMode(p27); // Use pin 27 to control the sleep mode of can1 CAN can2(p30, p29); // CAN2 uses pins 30 and 29 (rx, tx) and pin 28 (rs) DigitalOut can2_SleepMode(p28); // Use pin 28 to control the sleep mode of can2 bool logOpen = false; FILE *file; char fileName[32] = "" ; char writeBuffer[maxBufLen][13]; int writePointer = 0; int secsIdle = canTimeout; bool canIdle = true; Serial pc(USBTX, USBRX); extern "C" void RTC_IRQHandler() { timer.reset(); // zero ms at the-seconds-tic canIdle=(++secsIdle>canTimeout); LPC_RTC->ILR |= (1<<0); // clear interrupt to prepare for next } extern "C" void RTC_Init (void) { LPC_RTC->ILR=0x00; // set up the RTC interrupts LPC_RTC->CIIR=0x01; // interrupts each second LPC_RTC->CCR = 0x01; // Clock enable //NVIC_SetPriority( RTC_IRQn, 10 ); NVIC_EnableIRQ( RTC_IRQn ); } unsigned short getTimeStamp() { int msec = timer.read_ms() ; // read ms from the timer unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900 int isecs = secs%60 ; // modulo 60 for 0-59 seconds from RTC return ((isecs<<10)+msec) ; // return the two byte time stamp } void readLog (){ unsigned char c; int i=0; char lastMsgNum[]={0,0}; char curMsgNum[]={0,0}; char canNum=0; pc.printf("printing file\n"); file = fopen(fileName, "r"); if (file == NULL) { pc.printf("no file found\n"); } while (!feof(file)) { c=fgetc(file); pc.printf("%02x ",c); if (i==0){ canNum=c; }else if (i==5){ curMsgNum[canNum]=c; } if (++i>12) { if (curMsgNum[canNum]>(lastMsgNum[canNum]+1)) { pc.printf(" ***"); } lastMsgNum[canNum]=curMsgNum[canNum]; pc.printf("\n"); i=0; } } pc.printf("\n\n"); fclose(file); } void logCan (char mtype, CANMessage canRXmsg) { unsigned short ts = getTimeStamp(); writeBuffer[writePointer][0]=mtype; writeBuffer[writePointer][1]=ts>>8; writeBuffer[writePointer][2]=ts&0xff; writeBuffer[writePointer][3]=canRXmsg.id&0xff; writeBuffer[writePointer][4]=(canRXmsg.id>>8)+(canRXmsg.len<<4); for (int i = 5; i<13; i++){ writeBuffer[writePointer][i]=canRXmsg.data[i-5]; } if (++writePointer >= maxBufLen) { writePointer = 0; led4 = !led4; } } void recieve1() { CANMessage msg1; unsigned short msgTime=getTimeStamp(); static int lastMsg1 = 0; secsIdle=0; // reset deadman switch can1.read(msg1); if (msg1.id!=0x000) { if (msg1.data[0]>(lastMsg1+1)) { pc.printf("%sCan1 Message %d missed! \n", upLine, lastMsg1+1); } lastMsg1=msg1.data[0]; if(logOpen) logCan(1, msg1); led1 = !led1; } } void recieve2() { CANMessage msg2; unsigned short msgTime=getTimeStamp(); static int lastMsg2 = 0; secsIdle=0; // reset deadman switch can2.read(msg2); if (msg2.id!=0x000) { if (msg2.data[0]>(lastMsg2+1)) { pc.printf("%sCan2 Message %d missed! \n", upLine, lastMsg2+1); } lastMsg2=msg2.data[0]; if(logOpen) logCan(2, msg2); led2 = !led2; } } int main() { int readPointer=0; pc.baud(460800); // change serial interface to pc to 450800, 8N1 CANMessage tsMsg; can1.frequency(500000); can2.frequency(500000); can1_SleepMode = 1; // Monitor_only Mode can2_SleepMode = 1; // Monitor_only Mode CD.mode(PullUp) ; //SDRAM Chip Detect PB1.mode(PullUp) ; //Pushbutton 1 can1.attach(&recieve1); can2.attach(&recieve2); timer.start() ; RTC_Init(); // start the RTC Interrupts that sync the timer wait(1.1); // give time to sync while (true) { if(CD == 1) { int fileNum = 0; sprintf(fileName,"/sd/CANcan%d.alc",fileNum); file = fopen(fileName, "r"); while ((file != NULL)&&(fileNum++<100)) { fclose(file); sprintf(fileName,"/sd/CANcan%d.alc",fileNum); file = fopen(fileName, "r"); } file = fopen(fileName, "wb"); if(file==NULL){ pc.printf("\nUnable to open canlog\n\n\n\n"); mbed_reset(); } else { logOpen = true; readPointer=writePointer; pc.printf("\nStarting Can Log %s\n\n\n\n",fileName); unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900 tsMsg.id=0xfff; tsMsg.len=0xf; tsMsg.data[0]=secs&0xff; tsMsg.data[1]=(secs>>0)&0xff; tsMsg.data[2]=(secs>>16)&0xff; tsMsg.data[3]=secs>>24; tsMsg.data[4]=0xff; tsMsg.data[5]=0xff; tsMsg.data[6]=0xff; tsMsg.data[7]=0xff; logCan(0,tsMsg); //write full timestamp fclose(file); } do { if (((writePointer+maxBufLen-readPointer)%maxBufLen)>(maxBufLen/2)||canIdle||(PB1==0)) { // Dump buffer if > 1/2 full, canbus has stopped, or PB1 pressed if (logOpen) { file = fopen(fileName, "ab"); if (file == NULL) { logOpen = false; pc.printf("Failed to append log file.\n\n"); } else { while (readPointer != writePointer) { for (int j = 0; j<13; j++){ fprintf(file,"%c",writeBuffer[readPointer][j]); } if(++readPointer >= maxBufLen) readPointer=0; } led3 = !led3; fclose(file); } } // if (logOpen) } if (canIdle) { // canbus idle --> sleep to save power LPC_RTC->CIIR=0x00; // block RTC interrupts led1=0; led2=0; led3=0; led4=0; while (secsIdle>canTimeout) __wfi(); // freeze CPU and wait for interrupt (from canbus) LPC_RTC->CIIR=0x01; // re-enable RTC interrupts } wait(0.25); // We get >2K messages per second } while ((PB1==1)&&(CD==1)&&!canIdle); // keep going until button or SDram removed logOpen=false; pc.printf("Stopping log\n\n"); } else { pc.printf("\nNo SDRAM Inserted.\n\n\n\n"); } //if (CD==1) wait(1); } //while (true) }