适配110V美标控制盒:高度量程改为1000~1430mm,431点补偿表采样410点完成校准

This commit is contained in:
2026-09-09 13:58:03 +08:00
parent 41021cf95c
commit 130904e0a2
3 changed files with 60 additions and 57 deletions
+10 -7
View File
@@ -30,8 +30,11 @@
#define TRAVEL_TIME_MS 50000
#define PEAK 1200 //1200mm
#define VALLEY 720 //720mm
#define PEAK 1430 //最高高度mm
#define VALLEY 1000 //最低高度mm
/*高度转应力表索引: 补偿表431点覆盖1000~1430mm(430个步进), 接收范围已保证不越界*/
#define HEIGHT_TO_IDX(h) ((h) - 1000)
#define BDC_STOP() (SET_TWIN_BIT0(),SET_TWIN_BIT1())
#define BDC_DOWN() (SET_TWIN_BIT0(),CLR_TWIN_BIT1())
@@ -75,12 +78,12 @@ typedef struct{//电机参数
bool RestFlag;
bool CaliFlag;
bool LoopOne;//循环一次标志位
int16_t Current_height;//当前高度mm
int16_t Current_height;//当前高度mm(控制盒上报1000~1430)
int16_t CaliNum;//标校数量
int32_t LU_HeightStress[488];//左上传感器对应高度应力
int32_t LL_HeightStress[488];//左下传感器对应高度应力
int32_t RU_HeightStress[488];//右上传感器对应高度应力
int32_t RL_HeightStress[488];//右传感器对应高度应力
int32_t LU_HeightStress[431];//左上传感器对应高度应力
int32_t LL_HeightStress[431];//左下传感器对应高度应力
int32_t RU_HeightStress[431];//右上传感器对应高度应力
int32_t RL_HeightStress[431];//右传感器对应高度应力
}MotorPara_t;
/*数据读取状态机*/
typedef enum {