|
@@ -171,12 +171,49 @@ int ProcMIDCARChassis(void * pa, iv::can::canmsg * pmsg)
|
|
|
|
|
|
const iv::can::canraw * praw = &(pmsg->rawmsg(i));
|
|
const iv::can::canraw * praw = &(pmsg->rawmsg(i));
|
|
unsigned char data[8];
|
|
unsigned char data[8];
|
|
- if(praw->id() == 0xC2)
|
|
|
|
|
|
+ if(praw->id() == 0x14)
|
|
{
|
|
{
|
|
memcpy(data,praw->data().data(),8);
|
|
memcpy(data,praw->data().data(),8);
|
|
|
|
+ double torque,dangwei,soc,vehspeed;
|
|
|
|
+ torque = data[3];
|
|
|
|
+ dangwei = data[7]>>6;
|
|
|
|
+ soc = data[6]; soc = soc *0.4;
|
|
|
|
+ vehspeed = (data[4]*256.0 + data[5])*0.05625;
|
|
|
|
|
|
iv::chassis xchassis;
|
|
iv::chassis xchassis;
|
|
- xchassis.set_soc(data[0]);
|
|
|
|
|
|
+ xchassis.set_torque(torque);
|
|
|
|
+ xchassis.set_shift(dangwei);
|
|
|
|
+ xchassis.set_soc(soc);
|
|
|
|
+ xchassis.set_vel(vehspeed);
|
|
|
|
+
|
|
|
|
+ ShareChassis(pa,&xchassis);
|
|
|
|
+ nRtn = 1;
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return nRtn;
|
|
|
|
+
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+int ProcVV7Chassis(void * pa, iv::can::canmsg * pmsg)
|
|
|
|
+{
|
|
|
|
+ int i;
|
|
|
|
+ int nRtn = 0;
|
|
|
|
+ for(i=0;i<pmsg->rawmsg_size();i++)
|
|
|
|
+ {
|
|
|
|
+
|
|
|
|
+ const iv::can::canraw * praw = &(pmsg->rawmsg(i));
|
|
|
|
+ unsigned char data[8];
|
|
|
|
+ if(praw->id() == 0x13)
|
|
|
|
+ {
|
|
|
|
+ memcpy(data,praw->data().data(),8);
|
|
|
|
+ double engine_speed;
|
|
|
|
+
|
|
|
|
+ engine_speed = (data[5]*256.0 + data[6])*0.125;
|
|
|
|
+
|
|
|
|
+ iv::chassis xchassis;
|
|
|
|
+ xchassis.set_engine_speed(engine_speed);
|
|
|
|
+
|
|
|
|
|
|
ShareChassis(pa,&xchassis);
|
|
ShareChassis(pa,&xchassis);
|
|
nRtn = 1;
|
|
nRtn = 1;
|