View source for CAN bus battery monitor with 3.5" TFT Touch screen on Arudino MEGA2560

==Synopsis==
==Notes==

This version trimmed off several bytes of RAM and provides additional speedup (approx 1ms per update)
Fixed voltage sum bug.
[[LCDWIKI Libraries]]



==Code==
<syntaxhighlight lang="C++" line='line'>

#define ARDUINO_MEGA2560
//Arduino MEGA 2560
//MCP2515
////Pin 52 SPI clock
////Pin 50 MISO
////Pin 51 MOSI
////Pin 53 Cable Select

#include <SPI.h>
#include "mcp_can.h"
#include <LCDWIKI_GUI.h> //Core graphics library
#include <LCDWIKI_KBV.h> //Hardware-specific library
#include <TouchScreen.h> //touch library

//Software constants
#define NUMPACKS 4     //Number of packs installed on line.  Must edit knownID[] array
#define NUMCELLS 8     //Hazardous to modify
#define REFRESH 1000   //Refresh rate display
#define ALARM 3.660    //Alarm threshold
//define some colour values
#define BLACK   0x0000
#define BLUE    0x001F
#define RED     0xF800
#define GREEN   0x07E0
#define CYAN    0x07FF
#define MAGENTA 0xF81F
#define YELLOW  0xFFE0
#define WHITE   0xFFFF
#define ORANGE  0xFC00
#define GREY    0x1863
#define BACKGRD 0x2965

//RED 1111 1000 0000 0000
//BLU 0000 0000 0001 1111
//GRE 0000 0111 1110 0000
//GRY 0001 1000 0110 0011 = 0x01863

//Touchscreen
#define YP A3  // must be an analog pin, use "An" notation!
#define XM A2  // must be an analog pin, use "An" notation!
#define YM 9   // can be a digital pin
#define XP 8   // can be a digital pin
#define MINPRESSURE 10
#define MAXPRESSURE 1000
#define TS_MINX 906
#define TS_MAXX 116
#define TS_MINY 92
#define TS_MAXY 952

//Globals
bool buzzer = HIGH;
#ifdef ARDUINO_MEGA2560
const int spiCSPin = 53;
#endif

float voltage[NUMPACKS][NUMCELLS];
int temperature[NUMPACKS][NUMCELLS];

float sum[NUMPACKS];
long knownID[NUMPACKS] = {0x00000018, 0x00000020, 0x00000006, 0x00000012};
long packID;
int slot;
int c= 0;
int p= 0;
float Pack = 0.0;
bool msg5 = LOW;

//unsigned char bufA[10];
//unsigned char buf0[10];
//unsigned char buf3[10];
//unsigned char buf5[10];
//unsigned char buf20[10];
//unsigned char buf21[10];
//unsigned char buf22[10];

unsigned long time;
unsigned long TriggerTime = 0;
unsigned long unknownId = 0;
int count=0;

TouchScreen ts = TouchScreen(XP,YP, XM, YM, 300);
MCP_CAN CAN(spiCSPin);

//if the IC model is known or the modules is unreadable,you can use this constructed function
LCDWIKI_KBV mylcd(ILI9486,A3,A2,A1,A0,A4); //model,cs,cd,wr,rd,reset
//if the IC model is not known and the modules is readable,you can use this constructed function
//LCDWIKI_KBV mylcd(320,480,A3,A2,A1,A0,A4);//width,height,cs,cd,wr,rd,reset

void setup()
{
long st, fn;
int q;  
  Serial.begin(115200);

  //Graphics
  mylcd.Init_LCD();
  Serial.println(mylcd.Read_ID(), HEX);
  BuildScreen(0);

  //Pin 49 voltage alarm
  pinMode(49, OUTPUT);
  //Initialize against undefined values
  for(int i=0;i<NUMPACKS;i++)
  {
    for(int j=0;j<NUMCELLS;j++)
    {
      voltage[i][j]=0.0;
      temperature[i][j]=0;
    }
  }

  while (CAN_OK != CAN.begin(CAN_125KBPS,MCP_8MHz))
  {
    Serial.println("CAN BUS Init Failed, waiting for hardware...");
    delay(100);
  }
  Serial.println("CAN BUS  Init OK!");

}

void loop()
{
  long msgID = 0x00000FFF;
  bool skip = LOW;
  unsigned char len = 0;
  unsigned char buf[10];
  unsigned long canId = 0x00000000;

  //WARNING - Touch screen may be blocking
  digitalWrite(13, HIGH);
  TSPoint p = ts.getPoint();
  digitalWrite(13, LOW);
  pinMode(XM, OUTPUT);
  pinMode(YP, OUTPUT);
  if (p.z > MINPRESSURE && p.z < MAXPRESSURE)
  {
    //p.x = my_lcd.Get_Display_Width()-map(p.x, TS_MINX, TS_MAXX, my_lcd.Get_Display_Width(), 0);
    //p.y = my_lcd.Get_Display_Height()-map(p.y, TS_MINY, TS_MAXY, my_lcd.Get_Display_Height(), 0);
    p.x = map(p.x, TS_MINX, TS_MAXX, mylcd.Get_Display_Width(),0);
    p.y = map(p.y, TS_MINY, TS_MAXY, mylcd.Get_Display_Height(),0);

    Serial.print("Touch detect x=");
    Serial.print(p.x);
    Serial.print(" y=");
    Serial.println(p.y);        
  }

  if(CAN_MSGAVAIL == CAN.checkReceive())
  {
    CAN.readMsgBuf(&len, buf);
    canId = CAN.getCanId();
    Serial.print("p");//packet received

    if (canId & 0xFFFFF000 != 0x08010000)
    {
      Serial.println("Unsupported device attached!  Correct and restart monitor.");
      Serial.print("Device: 0x");
      Serial.print(canId & 0xFFFFF000,HEX);
      Serial.println(".");
      //Sound alarm
      digitalWrite(8,1);
      while(1){}
    }
    
    //detect if pack is registered
    packID = canId & 0x000000FF;
    slot = 0xFF;
    for(int i = 0; i<NUMPACKS ; i++)
    {
      if(knownID[i]==packID)
      {
        slot=i;
      }
      if(i==NUMPACKS-1 && slot==0xFF)
      {
        Serial.println("Unregistered Device attached!  Skipping!");
        Serial.print("  Device : 0x");
        Serial.print(packID,HEX);
        Serial.println(".");
        skip = HIGH;    
      }
    }
    
    //If pack is registered, collect it's data into local storage.
    if(!skip)
    {
    
      msgID = canId & 0x00000F00;
      //Interpret message 3
      if (msgID == 0x00000300)
      {        
        //Copy seven values to temperature[][]
        if(buf[0]==0)
        {
          for(int i=0;i<NUMCELLS-1;i++)
          {
            temperature[slot][i]=tempconvert(buf[i+1]); //i+1 because buf[0] is a count register
          }
        }
        //Copy one value to temperature[][0] wich is cell 1.
        if(buf[0]==1)
        {
          temperature[slot][7]=tempconvert(buf[1]);
        }
        //unknown temperature code
        if(buf[0]>1)
        {
          Serial.println("Unknown Temperature code");
        }
        //for(int i = 0; i<len; i++) {buf3[i] = buf[i];}
      }
      //Interpret message 5
      else if (msgID == 0x00000500) ;//{for(int i = 0; i<len; i++){buf5[i] = buf[i];}}
      //Interpret message A
      else if (msgID == 0x00000A00) ;//{for(int i = 0; i<len; i++){bufA[i] = buf[i];}}
      //Interpret message 0
      else if (msgID == 0x00000000) ;//{for(int i = 0; i<len; i++){buf0[i] = buf[i];}}
      //Interpret message 2
      else if (msgID == 0x00000200)
      {
        if (buf[0] == 0)
        {
          voltage[slot][7] = (buf[2] * 256 + buf[1]) / 1000.0;
          voltage[slot][6] = (buf[4] * 256 + buf[3]) / 1000.0;
          voltage[slot][5] = (buf[6] * 256 + buf[5]) / 1000.0;
          //for(int i = 0; i<len; i++){buf20[i] = buf[i];} 
        }
        if (buf[0] == 1)
        {
          voltage[slot][4] = (buf[2] * 256 + buf[1]) / 1000.0;
          voltage[slot][3] = (buf[4] * 256 + buf[3]) / 1000.0;
          voltage[slot][2] = (buf[6] * 256 + buf[5]) / 1000.0;
          //for(int i = 0; i<len; i++){buf21[i] = buf[i];}
        }
        if (buf[0] == 2)
        {
          voltage[slot][1] = (buf[2] * 256 + buf[1]) / 1000.0;
          voltage[slot][0] = (buf[4] * 256 + buf[3]) / 1000.0;
          //for(int i = 0; i<len; i++){buf22[i] = buf[i];}
        }
      }
      else 
      {
        unknownId = canId;
        Serial.println("Unexpected Message type detected!");
        Serial.println(canId & 0x00000F00, HEX);
      }
      
      //Run every REFRESHms
      time = millis();
      if (time >= TriggerTime)
      {
        //TestTemp();
        //Detect for alarm condition
        for(int i=0; i<NUMPACKS;i++)
        {
          sum[i]=0.0;
          for(int j=0;j<NUMCELLS;j++)
          {
            sum[i] += voltage[i][j];
            if(voltage[i][j]>=ALARM)  buzzer=HIGH;
          }            
        }
        
        //Execute alarm condition
        if(buzzer)
          digitalWrite(49,1);
        else
          digitalWrite(49,0);        
        TriggerTime = TriggerTime + REFRESH;
        
        //Dump cell voltages to CSV
        /*
        Pack=0.0;
        for(int i=0; i<NUMPACKS;i++)
        {
          Pack=0.0;
          for(int j=0; j<NUMCELLS ; j++) 
          {

            Serial.print(voltage[i][j],3);
            Serial.print(",");


            Pack += voltage[i][j];

          }
          Serial.print(Pack,3);
          if(NUMPACKS-1!=i)
            Serial.print(',');
          else
            Serial.println();     
        }
        */
        //END Dump cell voltages to CSV
        
        if(unknownId != 0)
        {
          Serial.print("Unknown Message: ");
          Serial.print(unknownId, HEX);
          Serial.println();
        }
        
      }

    }
    else skip=LOW;    
  }
  else
  {
    UpdateScreen(0);
  }
}

void BuildScreen(int ScreenMode)
{
  //Home Screen
  if(ScreenMode==0)
  {
    mylcd.Fill_Screen(BACKGRD);

    //Draw Blues
    mylcd.Set_Draw_color(32,0,255);
    mylcd.Fill_Rectangle(0, 0, mylcd.Get_Display_Width()-1, 26);

    //Draw Blacks
    mylcd.Set_Draw_color(0,0,0);
    mylcd.Fill_Rectangle(10,42 , 150, 191);   //Pack 1
    mylcd.Fill_Rectangle(170,42 , 310, 191);//Pack 2
    mylcd.Fill_Rectangle(10,234 , 150, 386);//Pack 3
    mylcd.Fill_Rectangle(170, 234 , 310, 386);//Pack 4

    //Draw Lines
    mylcd.Set_Draw_color(WHITE);
    mylcd.Draw_Line(11, 62, 149, 62);//Pack 1
    mylcd.Draw_Line(171, 62, 309, 62);//Pack 2
    mylcd.Draw_Line(11, 254, 149, 254);//Pack 3
    mylcd.Draw_Line(171, 254, 309, 254);//Pack 4

    //Draw Reds 
    mylcd.Set_Draw_color(RED);
    mylcd.Fill_Rectangle(10,193 , 150, 214);//Pack 1
    mylcd.Fill_Rectangle(170,193, 310, 214);//Pack 2
    mylcd.Fill_Rectangle(10,384 , 150, 407);//Pack 3
    mylcd.Fill_Rectangle(170,384, 310, 407);//Pack 4

    mylcd.Set_Text_colour(CYAN);
    mylcd.Set_Text_Mode(1);
    mylcd.Set_Text_Size(3);
    mylcd.Print_String("Battery Monitor", 30, 0);

    mylcd.Set_Text_Size(2);
    mylcd.Set_Text_Back_colour(BLACK);
    mylcd.Set_Text_colour(WHITE);
    mylcd.Print_String("  x18    (-)   x20    (-)", 4, 30+16*1);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*2);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*3);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*4);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*5);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*6);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*7);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*8);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*9);
    mylcd.Print_String(" (+)       V  (+)       V", 4, 38+16*10);
    mylcd.Print_String("  x06    (-)   x12    (-)", 4, 30+16*13);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*14);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*15);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*16);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*17);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*18);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*19);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*20);
    mylcd.Print_String(" -.---V  --F  -.---V  --F", 4, 32+16*21);
    mylcd.Print_String(" (+)       V  (+)       V", 4, 38+16*22);

    //credits, statusbar
    mylcd.Set_Text_colour(CYAN);
    mylcd.Print_String("Caleb Box and Timothy Legg", 4, 32+16*27);
  }
  return;
}

void UpdateScreen(int battery)
{
  
  int xc, yc;
  if(p==0 || p==1)
  {
    yc=64+(16*c);
  }
  if(p==2 || p==3)
  {
    yc=256+(16*c);
  }
  if(p==0 || p==2)
  {
    xc=14;
  }
  if(p==1 || p==3)
  {
    xc=172;
  }
  mylcd.Set_Text_Mode(0);
  mylcd.Set_Text_Back_colour(BLACK);
  mylcd.Set_Text_colour(GREEN);
  if(voltage[p][c]> 3.600 || voltage[p][c] < 3.200) mylcd.Set_Text_colour(YELLOW);
  if(voltage[p][c]> 3.645 || voltage[p][c] < 3.150) mylcd.Set_Text_colour(ORANGE);
  if(voltage[p][c]< 2.900 || voltage[p][c] > 3.650) mylcd.Set_Text_colour(RED);
  if(voltage[p][c]<= 0.0001) mylcd.Set_Text_colour(GREY);

  if(p!=4) mylcd.Print_Number_Float(voltage[p][c], 3, xc,yc, '.', 0, ' ');
  if(p!=4) mylcd.Print_Number_Int(temperature[p][c], xc+96,yc,2, ' ', 10);
  
  if(c==7)
  {
    mylcd.Set_Text_Mode(0);
    mylcd.Set_Text_colour(WHITE);
    mylcd.Set_Text_Back_colour(RED);
    mylcd.Print_Number_Float(sum[p], 3, xc+60, yc+22, '.', 0, ' ');
    mylcd.Set_Text_Back_colour(BLACK);
  }
  if(c<NUMCELLS){c++;}
  if(c==NUMCELLS){p++;c=0;}
  if(p==NUMPACKS){p=0;}
  buzzer=LOW;
  return;
}
char tempconvert(char raw)
{
  //Fahrenheit
  //Supports Rounding
  //if( (raw*1.555)-26.0 - (int) ((raw*1.555)-26.0) >= 0.5)
  //  return (int)((raw*1.555)-25.0);
  //else
  //  return (int)((raw*1.555)-26.0);
  short static const table[256] = 
                     {-26, -24,-23,-21,-20,-18,-17,-15,-14,-12,-10,-9,-7,-6,-4,-3,-1,
                      0,2,4,5,7,8,10,11,13,14,16,18,19,21,22,24,25,27,28,30,32,33,35,
                      36,38,39,41,42,44,46,47,49,50,52,53,55,56,58,60,61,63,64,66,67,
                      69,70,72,74,75,77,78,80,81,83,84,86,88,89,91,92,94,95,97,98,100,
                      102,103,105,106,108,109,111,112,114,116,117,119,120,122,123,125,
                      126,128,130,131,133,134,136,137,139,140,142,143,145,147,148,150,
                      151,153,154,156,157,159,161,162,164,165,167,168,170,171,173,175,
                      176,178,179,181,182,184,185,187,189,190,192,193,195,196,198,199,
                      201,203,204,206,207,209,210,212,213,215,217,218,220,221,223,224,
                      226,227,229,231,232,234,235,237,238,240,241,243,245,246,248,249,
                      251,252,254,255,257,259,260,262,263,265,266,268,269,271,273,274,
                      276,277,279,280,282,283,285,287,288,290,291,293,294,296,297,299,
                      301,302,304,305,307,308,310,311,313,315,316,318,319,321,322,324,
                      325,327,329,330,332,333,335,336,338,339,341,343,344,346,347,349,
                      350,352,353,355,357,358,360,361,363,364,366,367,369,371};
  return (int)table[raw]; 
}
</syntaxhighlight>