双柱双电机S型传感器基本功能完成

2025-10-14 17:44:33 +08:00
parent 1de51f1380
commit 92bb9bf934
4 changed files with 106 additions and 136 deletions
@@ -10,12 +10,16 @@
 #define 	OSC_CNT    			40
 #define 	SLOPE_CNT			  30

+#define 	SLOPE_VPT				1000
+#define		FOLLOW_VPT			20
+#define		SHIELD_VPT			5000
+
 #define 	STOP_TIME_MS		500
 #define 	RUN_TIME_MS			0

 #define	BDC_STOP()			(SET_TWIN_BIT0(),SET_TWIN_BIT1())
-#define 	BDC_UP()				(CLR_TWIN_BIT0(),SET_TWIN_BIT1())
-#define	BDC_DOWN()			(SET_TWIN_BIT0(),CLR_TWIN_BIT1())
+#define BDC_UP()			(SET_TWIN_BIT0(),CLR_TWIN_BIT1())
+#define	BDC_DOWN()			(CLR_TWIN_BIT0(),SET_TWIN_BIT1())
 	
 /*控制等级*/
 typedef enum {
@@ -66,6 +70,8 @@ typedef enum {
 	APP_STATUS_IDLE,
 	APP_STATUS_ON,
 	APP_STATUS_OFF,
+	APP_STATUS_UP_2S,
+	APP_STATUS_DOWN_2S,
 	APP_STATUS_WAIT,
 }AppStatus_m;