sakthi priya amirtharaj
i2c working with old hk
Fork of
BAE_vr2_1_1
by 
green rosh
Diff: HK.cpp
- Revision:
- 14:ef6be8ac6569
- Parent:
- 13:1b37d98840d3
--- a/HK.cpp Wed Dec 17 05:25:04 2014 +0000
+++ b/HK.cpp Wed Dec 17 06:06:59 2014 +0000
@@ -1,273 +1,79 @@
#include "HK.h"
- MAX17048 master(A4,A5,100000);//object for battery gauge class--CHECK SDA,SCL LINES,FREQUENCY
- void FUNC_BATTERYGAUGE_INIT();
+DigitalOut SelectLine3 (D4); // MSB of Select Lines
+DigitalOut SelectLine2 (D3);
+DigitalOut SelectLine1 (D2);
+DigitalOut SelectLine0 (D1); // LSB of Select Lines
-//GPIO pins used=> D2-D12, A0-A1
-
-DigitalOut SelectLinesA[]={D2,D3,D4,D5};//to mux1=>voltage mux
-DigitalOut SelectLinesB[]={PTB18,D7,PTB19};//to mux2=>current mux(differential mux) Is this 3 or 4?
-DigitalOut SelectLinesC[]={PTC0,PTC4,PTC6,PTC7};//to mux3=>temp mux
+AnalogIn CurrentInput(A1); // Input from Current Multiplexer
+AnalogIn VoltageInput(A2); // Input from Voltage Multiplexer
+AnalogIn TemperatureInput(A3); // input from Temperature Multiplexer
-//--------------------------------------------MSB is SelectLines[0],LSB is SelectLines[3]--------------------------------
-
-AnalogIn CurrentInput(A0); // Input from Current Mux
-AnalogIn VoltageInput(A1); // Input from Voltage Multiplexer
-AnalogIn TemperatureInput(A2); /*Input from Temperature Multiplexer,thermistor Multiplexer- same multiplexer for both(lines 1-4 for thermistor,line 0 for temperature sensor)*/
-
-
-
-
-int quantiz(float start,float step,float x) // accepts min and measured values and step->quantises on a scale 0-15..(4 bit quantisation)
+SensorData Sensor;
+int quantiz(float start,float step,float x)
{
int y=(x-start)/step;
if(y<=0)y=0;
if(y>=15)y=15;
return y;
}
-
-void init_beacon(ShortBeacy* x,SensorDataQuantised y)
-{
- (*x).Voltage[0]=y.Vcell_soc>>4;//quantised value
- (*x).Temp[0]=y.PanelTemperature[0];//quantised value
- (*x).Temp[1]=y.PanelTemperature[1];//quantised value
- (*x).AngularSpeed[0]=y.AngularSpeed[0];
- (*x).AngularSpeed[1]=y.AngularSpeed[1];
-
- (*x).SubsystemStatus[0]=145;//dummy values----------to be changed-------------------
- (*x).ErrorFlag[0]=3;//dummy values----------to be changed-------------------
+ShortBeacy Shortbeacon;
+void init_beacon(ShortBeacy x){
+ ;
}
- SensorData SensorUQ;
- SensorDataQuantised SensorQuantised;
- ShortBeacy Shortbeacon;
+
-void FUNC_HK_MAIN()
+void FUNC_HK_MAIN()
{
- //define structure variables
-
-
-
+ printf("\nEntered function HK MAIN\n");
- //initialise all selectlines to zeroes->1st line of muxes selected
- SelectLinesA[0]=SelectLinesA[1]=SelectLinesA[2]=SelectLinesA[3]=0;
- SelectLinesB[0]=SelectLinesB[1]=SelectLinesB[2]=0;
- SelectLinesC[0]=SelectLinesC[1]=SelectLinesC[2]=SelectLinesC[3]=0;
+ Shortbeacon.Voltage[0]=1;
+ Shortbeacon.AngularSpeed[0]=2;
+ Shortbeacon.AngularSpeed[1]=3;
+ Shortbeacon.SubsystemStatus[0]=145;
+ Shortbeacon.Temp[0]=1;
+ Shortbeacon.Temp[1]=2;
+ Shortbeacon.Temp[2]=3;
+ Shortbeacon.ErrorFlag[0]=3;
int LoopIterator;
- int SelectLineIterator;
-
- float resistance_thermistor,voltage_thermistor;//for thermistor
+
+ SelectLine0=0;
+ SelectLine1=0;
+ SelectLine2=0;
+ SelectLine3=0;
- //measurement from voltage sensor=> 16 sensors in place
- for(LoopIterator=0; LoopIterator<16; LoopIterator++)
-{
- //following lines read the sensor values and stores them in 'SensorData' structure's variable 'Sensor'
- SensorUQ.Voltage[LoopIterator]=(VoltageInput.read()*3.3*5.545454);//resistors in voltage divider=>15Mohm,3.3Mohm
-
- if(LoopIterator%2==0)
- SensorQuantised.Voltage[LoopIterator/2]=quantiz(vstart,vstep,SensorUQ.Voltage[LoopIterator]);
-
- else
- SensorQuantised.Voltage[(LoopIterator)/2]=SensorQuantised.Voltage[(LoopIterator)/2]<<4+quantiz(vstart,vstep,SensorUQ.Voltage[LoopIterator]);
-
-
-
- // The following lines are used to iterate the select lines from 0 to 15
- //following is an algorithm similar to counting binary numbers of 4 bit
- for(SelectLineIterator=3;SelectLineIterator>=0;SelectLineIterator--)
- {
- if(SelectLinesA[SelectLineIterator]==0)
- {
- SelectLinesA[SelectLineIterator]=1;
- break;
- }
- else SelectLinesA[SelectLineIterator]=0;
-
+ for(LoopIterator=0; LoopIterator<16; LoopIterator++) {
+
+ if(LoopIterator%2==0) {
+ Sensor.Current[LoopIterator/2]=quantiz(cstart,cstep,((CurrentInput.read()*3.18)/(50*rsens)));
+ Sensor.Voltage[LoopIterator/2]=quantiz(vstart,vstep,(VoltageInput.read()*3.18*5.37));
+ Sensor.Temperature[LoopIterator/2]=quantiz(tstart,tstep,(-90.7*3.18*TemperatureInput.read()+190.1543));
+ } else {
+ Sensor.Current[(LoopIterator-1)/2]=(Sensor.Current[(LoopIterator-1)/2]<<4)+quantiz(cstart,cstep,((CurrentInput.read()*3.18)/(50*rsens)));
+ Sensor.Voltage[(LoopIterator-1)/2]=(Sensor.Voltage[(LoopIterator-1)/2]<<4)+quantiz(vstart,vstep,(VoltageInput.read()*3.18*5.37));
+ Sensor.Temperature[(LoopIterator-1)/2]=(Sensor.Temperature[(LoopIterator-1)/2]<<4)+quantiz(tstart,tstep,(-90.7*3.18*TemperatureInput.read()+190.1543));
}
-
-
- wait_us(10.0); // A delay of 10 microseconds between each sensor output. Can be changed.
+// The following lines are used to iterate the select lines from 0 to 15
+ SelectLine0=!(SelectLine0);
- }
-
-
-
-
+ if(LoopIterator%2==1)
+ SelectLine1=!(SelectLine1);
- //measurement from current sensor=> 8 sensors in place
-
- for(LoopIterator=0; LoopIterator<8; LoopIterator++)
-{
- //following lines read the sensor values and stores them in 'SensorData' structure variable 'Sensor'
- SensorUQ.Current[LoopIterator]=(CurrentInput.read()*3.3/(50*rsens));
- if(LoopIterator%2==0)
- SensorQuantised.Current[LoopIterator/2]=quantiz(cstart,cstep,SensorUQ.Current[LoopIterator]);
- else
- SensorQuantised.Current[(LoopIterator)/2]=SensorQuantised.Current[(LoopIterator)/2]<<4+quantiz(cstart,cstep,SensorUQ.Current[LoopIterator]);
-
+ if(LoopIterator%4==3)
+ SelectLine2=!(SelectLine2);
+
+ if(LoopIterator%8==7)
+ SelectLine3=!(SelectLine3);
- // The following lines are used to iterate the select lines from 0 to 7
- //following is an algorithm similar to counting binary numbers of 3 bits
- for(SelectLineIterator=2;SelectLineIterator>=0;SelectLineIterator--)
- {
- if(SelectLinesB[SelectLineIterator]==0)
- {
- SelectLinesB[SelectLineIterator]=1;
- break;
- }
- else SelectLinesB[SelectLineIterator]=0;
-
- }
-
-
wait_us(10.0); // A delay of 10 microseconds between each sensor output. Can be changed.
-}
-
-
-//measurement of temperature
-//temperature measurement=> 4 thermistors, 1 temperature sensor
-//mux line 1=>temp sensor, mux lines 2 to 5 =>thermistors
-
- for(LoopIterator=0; LoopIterator<5; LoopIterator++)
-{
- //following lines read the sensor values and stores them in 'SensorData' structure variable 'Sensor'
- SensorUQ.Temperature[LoopIterator]=(-90.7*3.3*TemperatureInput.read()+190.1543);
- voltage_thermistor=TemperatureInput.read()*3.3;//voltage across thermistor
- resistance_thermistor=24000*voltage_thermistor/(3.3-voltage_thermistor);//resistance of thermistor
- //PanelTemperature will be updated depending on voltage_thermistor value later in the lines to follow
-
- if(LoopIterator%2==0)
- {
- if(LoopIterator<1) //->corresponding to temperature sensor
- SensorQuantised.Temperature[(LoopIterator)/2]=quantiz(tstart,tstep,SensorUQ.Temperature[LoopIterator]);
-
- else //->corresponding to thermistor
- {
- if(voltage_thermistor<1.378) //Temperature>12 degC
- SensorUQ.PanelTemperature[(LoopIterator-1)]=(3694/log(24.032242*resistance_thermistor));
-
- else
- SensorUQ.PanelTemperature[(LoopIterator-1)]=(3365.4792/log(7.60404*resistance_thermistor));
-
-
- SensorQuantised.PanelTemperature[(LoopIterator-1)/2]=quantiz(tstart_thermistor,tstep_thermistor,SensorUQ.PanelTemperature[(LoopIterator-1)]);
-
- }
-
- }
+ }
+
+ printf("\nVoltage is %u\n",Shortbeacon.Voltage[0]);
+ printf("\nCurrent is %u\n",Shortbeacon.Temp[0]);
+
- else
- {
- if(LoopIterator<1)
- SensorQuantised.Temperature[(LoopIterator)/2]=SensorQuantised.Temperature[(LoopIterator)/2]<<4+quantiz(tstart,tstep,SensorUQ.Temperature[LoopIterator]);
-
- else
- {
- if(voltage_thermistor<1.378) //Temperature>12 degC
- SensorUQ.PanelTemperature[LoopIterator-1]=(3694/log(24.032242*resistance_thermistor));
-
-
- else
- SensorUQ.PanelTemperature[LoopIterator-1]=(3365.4792/log(7.60404*resistance_thermistor));
-
- SensorQuantised.PanelTemperature[(LoopIterator-1)/2]=SensorQuantised.PanelTemperature[(LoopIterator-1)/2]<<4+quantiz(tstart_thermistor,tstep_thermistor,SensorUQ.PanelTemperature[LoopIterator-1]);
-
- }
-
- }
-
-
-
-
-// The following lines are used to iterate the select lines from 0 to 4
-
- //following is an algorithm similar to counting binary numbers of 4 bit
- for(SelectLineIterator=3;SelectLineIterator>=0;SelectLineIterator--)
- {
- if(SelectLinesC[SelectLineIterator]==0)
- {
- SelectLinesC[SelectLineIterator]=1;
- break;
- }
- else SelectLinesC[SelectLineIterator]=0;
-
- }
-
-
- wait_us(10.0); // A delay of 10 microseconds between each sensor output. Can be changed.
+ printf("\nExited function HK MAIN\n");
}
-
-
-
- //update battery gauge parameters->
- float batteryparameters[4];//to populate battery parameters of struct variable Sensor
- FUNC_BATTERYGAUGE_MAIN(batteryparameters);//passing array to function
-
- SensorUQ.Vcell=batteryparameters[0];
- SensorUQ.soc=batteryparameters[1];
- SensorUQ.crate=batteryparameters[2];
- SensorUQ.alerts=batteryparameters[3];
-
- SensorQuantised.Vcell_soc=quantiz(Vcell_start,Vcell_step,SensorUQ.Vcell);
- SensorQuantised.Vcell_soc=SensorQuantised.Vcell_soc<<4+quantiz(soc_start,soc_step,SensorUQ.soc);
- SensorQuantised.alerts=SensorUQ.alerts;
- SensorQuantised.crate=quantiz(crate_start,crate_step,SensorUQ.crate);
-
-
- //update magnetometer data->
- //populate values in structure variable 'Sensor' from data to be given by Green
- SensorQuantised.AngularSpeed[0]=quantiz(AngularSpeed_start,AngularSpeed_step,SensorUQ.AngularSpeed[1]);
- SensorQuantised.AngularSpeed[0]=SensorQuantised.AngularSpeed[0]<<4+quantiz(AngularSpeed_start,AngularSpeed_step,SensorUQ.AngularSpeed[0]);
- SensorQuantised.AngularSpeed[1]=quantiz(AngularSpeed_start,AngularSpeed_step,SensorUQ.AngularSpeed[2]);
-
- //update gyro data->
- //populate values in structure variable 'Sensor' from data to be given by Green
- SensorQuantised.Bnewvalue[0]=quantiz(Bnewvalue_start,Bnewvalue_step,SensorUQ.Bnewvalue[1]);
- SensorQuantised.Bnewvalue[0]=SensorQuantised.Bnewvalue[0]<<4+quantiz(Bnewvalue_start,Bnewvalue_step,SensorUQ.Bnewvalue[0]);
- SensorQuantised.Bnewvalue[1]=quantiz(Bnewvalue_start,Bnewvalue_step,SensorUQ.Bnewvalue[2]);
-
-
-
-
- //update beacon structure
- init_beacon(&Shortbeacon,SensorQuantised);//Shortbeacon is passed
-
-
-}
-
-
-void FUNC_BATTERYGAUGE_MAIN(float array[])
-{
- float vcell=master.vcell();
- float soc=master.soc();
- float crate=master.crate();
-
- printf("\nVcell=%f",vcell);
- printf("\nSOC=%f",soc);
- printf("\nC_rate=%f",crate);
-
- array[0]=vcell;
- array[1]=soc;
- array[2]=crate;
- if (master.alerting()== true) //alert is on
- {
- array[3]=master.alertFlags();
- master.clearAlert();//clear alert
- master.clearAlertFlags();//clear all alert flags
- }
-
-
-}
-
-void FUNC_BATTERYGAUGE_INIT()
-{
- master.disable_sleep();
- master.disable_hibernate();
- master.socChangeAlertEnabled(true);//enabling alert on soc changing by 1%
- master.emptyAlertThreshold(1);//giving minimum value to disable it to disabling it----------------------
- master.vAlertMinMaxThreshold();//set min, max value of Valrt register
- master.vResetThresholdSet();//set threshold voltage for reset
- master.vResetAlertEnabled(true);//enable alert on reset for V < Vreset
-}
\ No newline at end of file