Diff: main.cpp

Revision:

5:38b2b8790b40

Parent:

4:28919318b141

--- a/main.cpp	Sun Mar 21 22:58:15 2021 +0000
+++ b/main.cpp	Sun Apr 11 09:08:16 2021 +0000
@@ -1,6 +1,8 @@
 #include "mbed.h"
 #include "bq79606.h"
-
+#include "math.h"
+#include "handlers.h"
+#include "ntc.h"
 // - - - PIN CONFIGURATION - - -
 
 DigitalIn bmsFault(PB_4);
@@ -9,11 +11,11 @@
 // - - - UART CONFIGURATION - - -
 
 Serial bms(PA_0, PA_1, 250000); //UART ka BMS Slaveu
-Serial pc1(USBTX, USBRX, 9600);//PC_10, PC_11,9600); //UART ka PCu Serijskom monitoru
+Serial pc1(USBTX, USBRX, 9600);//PC_10, PC_11,9600); //UART ka PCu Serijskom monitoru     
 
+//- - - CAN CONFIGURATION - - - 
 CAN can1(PB_8, PB_9, 500000);
-CANMessage message1;
-        
+CANMessage message1; 
 
 BYTE recBuff[1024];
 volatile int recLen=0;
@@ -21,50 +23,55 @@
 volatile bool full = false;
 volatile int rdLen=0;
 int counter = 0;
+volatile int devStat = 0;
+volatile int cbRun = 1;
+volatile int cbDone = 0;
+
+volatile int faultSUM = 0;
+volatile int DEVStat = 0;
+
+volatile double extern Vin;
+volatile double extern Rref;
 
 uint8_t pFrame1[(MAXBYTES+6)*TOTALBOARDS];
 
 void callback() {
     // Note: you need to actually read from the serial to clear the RX interrupt
-    //pc1.printf("* * *    Uspesan PRIJEM!     * * *\n");
-    
-        //pc1.printf("rec = %d", c);
         recBuff[recLen++] = bms.getc();
         if(expected==0) expected = recBuff[0]+7; //prvi bajt je (broj data - 1), +1 device id, +2 reg address, +2 CRC
-        //pc1.printf("Prva rec = %d", recBuff[0]); 
         if(expected == recLen){
-            //pc1.printf("\n\n- - - USAO U EXPECTED - - -\n"); 
-            full = true;
             rdLen = expected;
             expected = 0;
             recLen = 0;
+            full = true;
         }
-        
-    
-    //full = true;
-    //recLen = 0;
-    //rdLen = 17; //samo test - nebitno koji broj
 }
 
-void waitFrame(){
+int waitRegRead()
+{
     while(!full);
-    //wait(2);
+    wait_us(500);
     full=false;
-    pc1.printf("\n%d\n", rdLen);
-    for(int i = 0;i<rdLen;i++){
-        pc1.printf("%X ",recBuff[i]);
-    }
+    return recBuff[4];
+}
+  
+
+
+ 
+ void waitFrame(){
+    while(!full);
+    wait_us(500);
+    full=false;
     
     pc1.printf("\n\n- - - VOLTAGE - - -\n"); 
-    message1.id = 0x71;
+    message1.id = voltID;
     int j = 0;
     for(int i = 4; i < recBuff[0] + 4; i += 2){
         int voltage = recBuff[i+1];   //LSB
         voltage |= (recBuff[i]) << 8; //MSB
         double vol = voltage*0.0001907349;
-        //double vol = ((double)voltage)/65536.0 * 5.0;
         pc1.printf("CELL[%d] = %6.2f V\n", i/2-1, vol);
-        
+        //sendCAN(voltID, vol);
         message1.data[j++] = recBuff[i];
         
     }
@@ -74,51 +81,283 @@
 }
 
 
-void waitFrameTemp(){
+void waitFrameTemp(){ 
     while(!full);
-    //wait(2);
     full=false;
     pc1.printf("****** TEMPERATURA *****");
     pc1.printf("\n%d\n", rdLen);
     for(int i = 0;i<rdLen;i++){
         pc1.printf("%X ",recBuff[i]);
     }
-        int voltage = recBuff[5];   //LSB
-        voltage |= (recBuff[4]) << 8; //MSB
-        double vol = voltage*0.0001907349;
-        //double vol = ((double)voltage)/65536.0 * 5.0;
-        pc1.printf("temp1  = %f V\n", vol);
-   
+    int voltage = recBuff[5];   //LSB
+    voltage |= (recBuff[4]) << 8; //MSB
+    double Vout = voltage*0.0001907349;
+    int temp = naponskiRazdelnik(Vout);
+    sendCANbyte(tempID, temp);
+}
+
+void StartBalancingAndWaitToFinish()
+{
+    cbRun = 1;
+    cbDone = 0;
+    WriteReg(0, CB_CONFIG, 0xFA, 1, FRMWRT_ALL_NR); // Odds then Evens, continue regardless of fault condition, 30sec, seconds
+    
+    WriteReg(0, CB_DONE_THRESHOLD, 0x5F, 1, FRMWRT_ALL_NR); // Thresh hold set to value 3.6V, CBDONE comparators enabled
+    //Enabling the CBDONE voltage threshold overrides the OVUV function and pauses it.
+    
+    WriteReg(0, CB_CELL1_CTRL, 0xBC, 1, FRMWRT_ALL_NR);//cell 1- 1 minute balance timer
+    WriteReg(0, CB_CELL2_CTRL, 0xBC, 1, FRMWRT_ALL_NR);//cell 2- 1 minute balance timer
+    WriteReg(0, CB_CELL3_CTRL, 0xBC, 1, FRMWRT_ALL_NR);//cell 3- 1 minute balance timer
+    
+    WriteReg(0, CONTROL2, 0x30, 1, FRMWRT_ALL_NR);//BAL_GO set to 1, and TSREF enabled
+    wait_us(100);
+    pc1.printf("Setupovano balansiranje\n");
+    while (cbRun)
+    {
+        ReadReg(0, DEV_STAT, pFrame1, 1 , 0, FRMWRT_ALL_R);
+        wait(1);
+        devStat = recBuff[4];
+        cbRun = (devStat & 0x10) >> 4;
+        wait_us(500);
+        if (!cbRun)
+        {
+            pc1.printf("DEV STAT = %d\n", devStat);
+            pc1.printf("CBRUN = %d\n", cbRun);
+            //wait(10);
+        }
+    }
+    
+    while(!cbDone)
+    {
+        ReadReg(0, DEV_STAT, pFrame1, 1 , 0, FRMWRT_ALL_R);
+        wait(1);
+        devStat = recBuff[4];
+        cbDone = (devStat & 0x40) >> 6;
+        wait_us(500);
+        if (cbDone)
+        {
+            pc1.printf("DEV STAT = %d\n", devStat);
+            pc1.printf("CBDONE = %d\n", cbDone);
+            //wait(10);
+        }
+    }
+    // Cleanup
+    WriteReg(0, CONTROL2, 0x00, 1, FRMWRT_ALL_NR);//Reset
+    WriteReg(0, CB_DONE_THRESHOLD, 0x20, 1, FRMWRT_ALL_NR);
 }
-void waitFrameResponse(){
-    while(!full);
-    full = false;
-    for(int i = 0;i < rdLen; i++){
-        pc1.printf("%X ", recBuff[i]);
+
+void cellBalanceEnable()
+{
+    cbRun = 1;
+    cbDone = 0;
+    WriteReg(0, CB_CONFIG, 0xFA, 1, FRMWRT_ALL_NR); // Odds then Evens, continue regardless of fault condition, 30sec, seconds
+    
+    WriteReg(0, CB_DONE_THRESHOLD, 0x5F, 1, FRMWRT_ALL_NR); // Thresh hold set to value 3.6V, CBDONE comparators enabled
+    //Enabling the CBDONE voltage threshold overrides the OVUV function and pauses it.
+    
+    WriteReg(0, CB_CELL1_CTRL, 0xBC, 1, FRMWRT_ALL_NR);//cell 1- 1 minute balance timer
+    WriteReg(0, CB_CELL2_CTRL, 0xBC, 1, FRMWRT_ALL_NR);//cell 2- 1 minute balance timer
+    WriteReg(0, CB_CELL3_CTRL, 0xBC, 1, FRMWRT_ALL_NR);//cell 3- 1 minute balance timer
+    
+    WriteReg(0, CONTROL2, 0x30, 1, FRMWRT_ALL_NR);//BAL_GO set to 1, and TSREF enabled
+    wait_us(100);
+    pc1.printf("Setupovano balansiranje\n");
+}
+
+void waitBalancingToFinish()
+{
+      while (cbRun)
+    {
+        ReadReg(0, DEV_STAT, pFrame1, 1 , 0, FRMWRT_ALL_R);
+        wait(1);
+        devStat = recBuff[4];
+        cbRun = (devStat & 0x10) >> 4;
+        wait_us(500);
+        if (!cbRun)
+        {
+            pc1.printf("DEV STAT = %d\n", devStat);
+            pc1.printf("CBRUN = %d\n", cbRun);
+        }
     }
-    pc1.printf("\n");
+    
+    while(!cbDone)
+    {
+        ReadReg(0, DEV_STAT, pFrame1, 1 , 0, FRMWRT_ALL_R);
+        wait(1);
+        devStat = recBuff[4];
+        cbDone = (devStat & 0x40) >> 6;
+        wait_us(500);
+        if (cbDone)
+        {
+            pc1.printf("DEV STAT = %d\n", devStat);
+            pc1.printf("CBDONE = %d\n", cbDone);
+            //wait(10);
+        }
+    } 
+}
+
+void cellBalanceDisable()
+{
+     WriteReg(0, CONTROL2, 0x00, 1, FRMWRT_ALL_NR);//Reset
+     WriteReg(0, CB_DONE_THRESHOLD, 0x20, 1, FRMWRT_ALL_NR);
+}
+
+void isCellBalancingDone()
+{
+        ReadReg(0, DEV_STAT, pFrame1, 1 , 0, FRMWRT_ALL_R);
+        wait(1);
+        devStat = recBuff[4];
+        cbDone = (devStat & 0x40) >> 6;
+        cbRun = (devStat & 0x10) >> 4;
+        wait_us(500);
+        pc1.printf("cbDone= %d  cbRun= %d\n", cbDone, cbRun);
+        wait(104);
+        ReadReg(0, DEV_STAT, pFrame1, 1 , 0, FRMWRT_ALL_R);
+        wait(1);
+        devStat = recBuff[4];
+        cbDone = (devStat & 0x40) >> 6;
+        cbRun = (devStat & 0x10) >> 4;  
 }
 
+void faultRead()
+{
+    pc1.printf("\n FAULT REGISTER STATUS START \n");
+    
+    ReadReg(0, GPIO_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    gpioFault = waitRegRead();
+    GPIOHandler();
+    
+    ReadReg(0, UV_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    uvFault = waitRegRead();
+    UVHandler();
+    
+    ReadReg(0, OV_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    ovFault = waitRegRead();
+    OVHandler();
+    
+    ReadReg(0, UT_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    utFault = waitRegRead();
+    UTHandler();
+    
+    ReadReg(0, OT_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    otFault = waitRegRead();
+    OTHandler();
+    
+    ReadReg(0, TONE_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    toneFault = waitRegRead();
+    ToneHandler();
+    
+    ReadReg(0, COMM_UART_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    uartFault = waitRegRead();
+    UARTHandler();
+    
+    ReadReg(0, COMM_UART_RC_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    uartRCFault = waitRegRead();
+    UARTRCHandler();
+    
+    ReadReg(0, COMM_UART_RR_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    uartRRFault = waitRegRead();
+    UARTRRHandler();
+    
+    ReadReg(0, COMM_UART_TR_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    uartTRFault = waitRegRead();
+    UARTTRHandler();
+    
+    ReadReg(0, COMM_COMH_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    COMHFault = waitRegRead();
+    COMHHandler();
+    
+    ReadReg(0, COMM_COMH_RC_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    COMHRCFault = waitRegRead();
+    COMHRCHandler();
+    
+    ReadReg(0, COMM_COMH_RR_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    COMHRRFault = waitRegRead();
+    COMHRRHandler();
+    
+    ReadReg(0, COMM_COMH_TR_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    COMHTRFault = waitRegRead();
+    COMHTRHandler();
+    
+    ReadReg(0, COMM_COML_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    COMLFault = waitRegRead();
+    COMLHandler();
+
+    ReadReg(0, COMM_COML_RC_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    COMLRCFault = waitRegRead();
+    COMLRCHandler();
+    
+    ReadReg(0, COMM_COML_RR_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    COMLRRFault = waitRegRead();
+    COMLRRHandler();
+    
+    ReadReg(0, COMM_COML_TR_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    COMLTRFault = waitRegRead();
+    COMLHandler();
+    
+    ReadReg(0, OTP_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    otpFault = waitRegRead();
+    OTPHandler();
+    
+    ReadReg(0, RAIL_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R);
+    railFault = waitRegRead();
+    RAILHandler();
+    
+    ReadReg(0, OVUV_BIST_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    ovuvBistFault = waitRegRead();
+    OVUVBISTHandler();
+    
+    ReadReg(0, OTUT_BIST_FAULT, pFrame1, 1, 0, FRMWRT_ALL_R); 
+    otutBistFault = waitRegRead();
+    OTUTBISTHandler();
+    
+    pc1.printf("FAULT REGISTER STATUS END \n\n");
+}
+
+void checkDeviceStatus()
+{
+    pc1.printf("\n DEVICE STATUS START \n");
+    
+    ReadReg(0, FAULT_SUM, pFrame1, 1, 0, FRMWRT_SGL_R);
+    faultSUM = waitRegRead();
+    pc1.printf("Fault sum = %X\n", faultSUM);
+    
+    if(faultSUM != 0)
+    {
+        faultRead();
+    }
+    
+    ReadReg(0, DEV_STAT, pFrame1, 1, 0, FRMWRT_SGL_R);
+    DEVStat = waitRegRead();
+    pc1.printf("DEV STAT = %X\n", DEVStat);
+    
+    pc1.printf("DEVICE STATUS END\n");
+}
+
+void requestTemperature()
+{
+    WriteReg(0, CONTROL2, 0x02, 1, FRMWRT_ALL_NR);
+    ReadReg(0, AUX_GPIO1H, pFrame1, 2 , 0, FRMWRT_ALL_R); 
+        
+    waitFrameTemp();   
+    wait(1);
+}
+
+void requestVoltage()
+{
+    ReadReg(0, VCELL1H , pFrame1, 6 , 0, FRMWRT_ALL_R); //6 bajtova jer cita od adrese VCELL1H po dva bajta za svaki kanal (ima 3 kanala)
+    waitFrame();
+}
 
 int main(){
-    pc1.printf("Main ulazak\n");
     bms.attach(&callback);
-    pc1.printf("Main after attacha\n");
     Wake79606();
-    pc1.printf("woken up\n");
-    //DigitalOut(PA_0, 0);
-    //DigitalOut(PA_1, 0);
-    //wait(1);
-    //DigitalOut(PA_0, 1);
-    //DigitalOut(PA_1, 1);
-    //bms(PA_0, PA_1, 250000);
+
     bms.baud(10);
     bms.send_break();
     bms.baud(250000);
-    //wait_ms(500);
-    //bms.clear_break();
     
-    wait(2); //marta rekla da mozda treba da se doda wait
+    //wait(2); //marta rekla da mozda treba da se doda wait
     AutoAddress();
     
     
@@ -126,6 +365,7 @@
     
     wait(2);
     init();
+    arrayInit();
     /*WriteReg(0, COMM_TO, 0x00, 1, FRMWRT_ALL_NR); //disable COMM timeout because printf takes a long time between reads
     WriteReg(0, SYSFLT1_FLT_RST, 0xFFFFFF, 3, FRMWRT_ALL_NR);   //reset system faults
     WriteReg(0, SYSFLT1_FLT_MSK, 0xFFFFFF, 3, FRMWRT_ALL_NR);   //mask system faults (so we can test boards and not worry about triggering these faults accidentally)
@@ -133,37 +373,18 @@
     //SET UP MAIN ADC
     WriteReg(0, CELL_ADC_CTRL, 0x3F, 1, FRMWRT_ALL_NR);     //enable conversions for all cells
     WriteReg(0, CELL_ADC_CONF2, 0x08, 1, FRMWRT_ALL_NR);    //set continuous ADC conversions, and set minimum conversion interval
-    WriteReg(0, CONTROL2, 0x01, 1, FRMWRT_ALL_NR);          //CELL_ADC_GO = 1
-    wait_ms(5);*/
+    WriteReg(0, CONTROL2, 0x01, 1, FRMWRT_ALL_NR);          //CELL_ADC_GO = 1*/
     
-    //bmsWakeUp = 0;
-    pc1.printf("Pre while-a\n");
     while (1) {
-        pc1.printf("Main Code \n");
-                
-        pc1.printf("Board 0 \n");
-        
-        
-        
         
-        wait(2);
-        //while(bms.readable()) bms.getc();
-        int rdLen = ReadReg(0, VCELL1H , pFrame1, 6 , 0, FRMWRT_ALL_R); //6 bajtova jer cita od adrese VCELL1H po dva bajta za svaki kanal (ima 3 kanala)
-        
-        
-        
-        waitFrame();
+        requestVoltage();
+        requestTemperature();
+        /*cellBalanceEnable();
+        waitBalancingToFinish();
+        cellBalanceDisable();
+        isCellBalancingDone();*/
         
-        WriteReg(0, CONTROL2, 0x02, 1, FRMWRT_ALL_NR);
-        ReadReg(0, AUX_GPIO1H, pFrame1, 2 , 0, FRMWRT_ALL_R); 
-        
-        waitFrameTemp();
-        
-        
-        //slanje zahteva za GRESKAMA
-        //ReadReg(0, 0x52, &wTemp, 2, 0); // 0ms timeout
-        //waitFrameResponse();
-        
+        checkDeviceStatus();
 
     }