瀏覽代碼

开环强拖,D轴电压为负,角度需要朝减小的反向

Signed-off-by: kevin <huhui@sharkgulf.com>
kevin 2 年之前
父節點
當前提交
092d26a63f
共有 1 個文件被更改,包括 5 次插入1 次删除
  1. 5 1
      Applications/foc/motor/motor.c

+ 5 - 1
Applications/foc/motor/motor.c

@@ -1528,7 +1528,11 @@ static bool mc_process_force_running(void) {
 			if (motor.force_open_wait > 0) {
 				--motor.force_open_wait;
 			}else {
-				motor.force_open_angle += 1.5f;
+				float positive = 1.0f;
+				if (line_ramp_get_target(&motor.controller.ramp_target_vd) < 0) {
+					positive = -1.0f;
+				}
+				motor.force_open_angle += 1.5f * positive;
 				norm_angle_deg(motor.force_open_angle);
 				mot_contrl_set_angle(&motor.controller, motor.force_open_angle);
 			}