修复bug
This commit is contained in:
@@ -106,6 +106,8 @@ void ArmorFinder::antiTop(double dist_m, double pitch_imu_deg) {
|
|||||||
|
|
||||||
// 5. Check if it's time to fire
|
// 5. Check if it's time to fire
|
||||||
double fly_time_s = BallisticSolver::get_flight_time(dist_m, pitch_imu_deg, MUZZLE_VELOCITY, BALLISTIC_K);
|
double fly_time_s = BallisticSolver::get_flight_time(dist_m, pitch_imu_deg, MUZZLE_VELOCITY, BALLISTIC_K);
|
||||||
|
double total_delay_s = fly_time_s + SYSTEM_DELAY / 1000.0;
|
||||||
|
|
||||||
// 核心优化:O(1) 绝对相位耦合算法
|
// 核心优化:O(1) 绝对相位耦合算法
|
||||||
// 原理:子弹必须在装甲板精确到达 Yaw 中心的那一刻撞击
|
// 原理:子弹必须在装甲板精确到达 Yaw 中心的那一刻撞击
|
||||||
double T_face = abs((PI / 2.0) / auto_omega); // 陀螺转过一个面的理论耗时
|
double T_face = abs((PI / 2.0) / auto_omega); // 陀螺转过一个面的理论耗时
|
||||||
|
|||||||
@@ -90,7 +90,7 @@
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
#ifndef SYSTEM_DELAY
|
#ifndef SYSTEM_DELAY
|
||||||
#define SYSTEM_DELAY (50.0)
|
#define SYSTEM_DELAY (150.0)
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
// 到此为止
|
// 到此为止
|
||||||
|
|||||||
Reference in New Issue
Block a user