| | |
| | | static void UpdateCarBodyCoord(struct RtkTime *rtkTime, double azimuth, double pitch, double roll, PointF main_ant, car_model *carModel); |
| | | static bool UpdateCarCoord(double &spd, int &mov, int &idx); |
| | | |
| | | static void PrintObdInfo(struct RtkTime *rtkTime, double speed); |
| | | |
| | | void DriverTestInit(void) |
| | | { |
| | |
| | | if (ExamStart) { |
| | | ExecuteExam(speed, move, azimuth, &rtkTime); |
| | | } |
| | | |
| | | PrintObdInfo(&rtkTime, speed); |
| | | } |
| | | } |
| | | |
| | | |
| | | |
| | | static void PrintObdInfo(struct RtkTime *rtkTime, double speed) { |
| | | static struct RtkTime cTime = *rtkTime; |
| | | |
| | | if (TimeGetDiff(rtkTime, &cTime) >= D_SEC(3)) { |
| | | cTime = *rtkTime; |
| | | DEBUG("ENGINE_RPM %d OBD_SPEED %f SPEED %f", |
| | | ReadCarStatus(ENGINE_RPM), |
| | | ((double)ReadCarStatus(OBD_SPEED)) / 10.0, |
| | | speed * 3.6); |
| | | } |
| | | } |
| | | |