ftc/charger
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Больше показаний отдаём наверх

Browse Source
This commit is contained in:
ftc
2024-02-25 18:02:13 +03:00
parent 214784c27b
commit e8f2b39554
1 changed files with 14 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
charger/charger.ino
+14 -5
View File
@@ -10,6 +10,10 @@ ModbusRTU mb;
#define I_LAMP_HIGH_REGISTER 3 #define I_LAMP_HIGH_REGISTER 3
#define ACC_STATE_REGISTER 4 #define ACC_STATE_REGISTER 4
#define LAMP_STATE_REGISTER 5 #define LAMP_STATE_REGISTER 5
#define U_ACC_LOW_REGISTER 6
#define U_ACC_HIGH_REGISTER 7
#define U_LAMP_LOW_REGISTER 8
#define U_LAMP_HIGH_REGISTER 9
#define ACC_PIN 2 #define ACC_PIN 2
#define LAMP_PIN 3 #define LAMP_PIN 3
@@ -41,10 +45,16 @@ void setup()
mb.addHreg(I_LAMP_HIGH_REGISTER); mb.addHreg(I_LAMP_HIGH_REGISTER);
mb.addHreg(ACC_STATE_REGISTER); mb.addHreg(ACC_STATE_REGISTER);
mb.addHreg(LAMP_STATE_REGISTER); mb.addHreg(LAMP_STATE_REGISTER);
mb.addHreg(U_ACC_LOW_REGISTER);
mb.addHreg(U_ACC_HIGH_REGISTER);
mb.addHreg(U_LAMP_LOW_REGISTER);
mb.addHreg(U_LAMP_HIGH_REGISTER);
} }
float I_lamp; float I_lamp;
float I_acc; float I_acc;
float U_lamp;
float U_acc;
void ReadLamp() void ReadLamp()
{ {
@@ -55,6 +65,7 @@ void ReadLamp()
float v1 = a4 / 1023.0 * 5 * 3; float v1 = a4 / 1023.0 * 5 * 3;
float v2 = a5 / 1023.0 * 5 * 3; float v2 = a5 / 1023.0 * 5 * 3;
I_lamp = (v1 - v2) / R_lamp; I_lamp = (v1 - v2) / R_lamp;
U_lamp = v1;
} }
void ReadAcc() void ReadAcc()
@@ -66,6 +77,7 @@ void ReadAcc()
float v1 = a2 / 1023.0 * 5 * 3; float v1 = a2 / 1023.0 * 5 * 3;
float v2 = a3 / 1023.0 * 5 * 3; float v2 = a3 / 1023.0 * 5 * 3;
I_acc = (v1 - v2) / R_LIMITER; I_acc = (v1 - v2) / R_LIMITER;
U_acc = v1;
} }
void WriteFloatReg(int start, float val) void WriteFloatReg(int start, float val)
@@ -83,12 +95,9 @@ void loop()
ReadLamp(); ReadLamp();
ReadAcc(); ReadAcc();
WriteFloatReg(I_ACC_LOW_REGISTER, I_acc); WriteFloatReg(I_ACC_LOW_REGISTER, I_acc);
WriteFloatReg(U_ACC_LOW_REGISTER, U_acc);
WriteFloatReg(I_LAMP_LOW_REGISTER, I_lamp); WriteFloatReg(I_LAMP_LOW_REGISTER, I_lamp);
Serial.print("I_acc = "); WriteFloatReg(U_LAMP_LOW_REGISTER, U_lamp);
Serial.print(I_acc);
Serial.print(" I_lamp = ");
Serial.print(I_lamp);
Serial.println();
mb.task(); mb.task();
lamp_state = mb.Hreg(lamp_state); lamp_state = mb.Hreg(lamp_state);
acc_state = mb.Hreg(acc_state); acc_state = mb.Hreg(acc_state);