Browse Source

加入电机编号,如果nv的和现有的不相等,重新初始化电机参数

Signed-off-by: huhui <huhui@sharkgulf.com>
huhui 3 năm trước cách đây
mục cha
commit
7004b22d6e
2 tập tin đã thay đổi với 8 bổ sung4 xóa
  1. 7 4
      Applications/app/nv_storage.c
  2. 1 0
      Applications/app/nv_storage.h

+ 7 - 4
Applications/app/nv_storage.c

@@ -28,6 +28,7 @@ void nv_save_angle_offset(float offset) {
 
 
 static void nv_default_motor_params(void) {
+	m_params.mot_nr = MOTOR_NR;
 	m_params.poles = MOTOR_POLES;
 	m_params.r = MOTOR_R;
 	m_params.ld = MOTOR_Ld;
@@ -188,9 +189,11 @@ void nv_storage_init(void) {
 	nv_read_motor_params();
 	nv_read_foc_params();
 	sys_debug("encoder_off = %f\n", m_params.offset);
-	//nv_default_motor_params();
-	//nv_default_foc_params();
-	//nv_save_foc_params();
-	//nv_save_motor_params();
+	if (m_params.mot_nr != MOTOR_NR) {
+		nv_default_motor_params();
+		nv_default_foc_params();
+		nv_save_foc_params();
+		nv_save_motor_params();
+	}
 }
 

+ 1 - 0
Applications/app/nv_storage.h

@@ -29,6 +29,7 @@ typedef struct {
 }foc_params_t;
 
 typedef struct {
+	u8 mot_nr;
 	u8 poles;
 	float r;
 	float ld;