|
@@ -489,6 +489,7 @@ int ProcShenLanCANFDChassis(void *pa, iv::can::canmsg *pmsg)
|
|
|
|
|
|
xchassis.set_vel(static_cast<float>(vehspeed));
|
|
xchassis.set_vel(static_cast<float>(vehspeed));
|
|
ShareChassis(pa,&xchassis);
|
|
ShareChassis(pa,&xchassis);
|
|
|
|
+ xchassis.clear_angle_feedback();
|
|
std::cout<<"veh: "<<xchassis.vel()<<std::endl;
|
|
std::cout<<"veh: "<<xchassis.vel()<<std::endl;
|
|
}
|
|
}
|
|
else
|
|
else
|
|
@@ -512,7 +513,7 @@ int ProcShenLanCANFDChassis(void *pa, iv::can::canmsg *pmsg)
|
|
ang=static_cast<double>(value) * 0.1-65536*0.1;
|
|
ang=static_cast<double>(value) * 0.1-65536*0.1;
|
|
|
|
|
|
xchassis.set_angle_feedback(static_cast<float>(ang));
|
|
xchassis.set_angle_feedback(static_cast<float>(ang));
|
|
- ShareChassis(pa,&xchassis);
|
|
|
|
|
|
+ // ShareChassis(pa,&xchassis);
|
|
std::cout<<"ang: "<<xchassis.angle_feedback()<<std::endl;
|
|
std::cout<<"ang: "<<xchassis.angle_feedback()<<std::endl;
|
|
}
|
|
}
|
|
else
|
|
else
|