zhunk il y a 1 an
Parent
commit
7dd7e13c57

+ 2 - 1
Application_cbd_apm32f1/applications/beep.c

@@ -162,11 +162,12 @@ static int init_tim2(void)
 
 int hwtimer2_pwm3_output(rt_uint32_t time,rt_uint32_t freq,uint8_t EN,uint8_t DIR)
 {
-    init_pwm3();
     rt_pin_mode(Motor_EN, PIN_MODE_OUTPUT);
     rt_pin_mode(Motor_DIR, PIN_MODE_OUTPUT);
     rt_pin_write(Motor_EN, EN);
     rt_pin_write(Motor_DIR, DIR);
+    init_pwm3();
+
     rt_pwm_set(pwm_device, BEEP_PWM_CH, freq, freq/2);//channel,period,pulse
     if(init_tim2()==0)
         rt_pwm_enable(pwm_device, BEEP_PWM_CH); //使能蜂鸣器对应的 PWM 通道

+ 104 - 0
Application_cbd_apm32f1/applications/control.c

@@ -2042,6 +2042,110 @@ static void pin_guangshan_unbind(void)
     rt_pin_detach_irq(GUANG_SHAN);
 }
 
+#define PULES    1  //延时时间  ms 5.0测报灯电机归零延时使用
+
+void slidelock()
+{
+    ctr_Motor_Driver_Power(ON);  //电机驱动供电
+    rt_thread_delay(300);
+    rt_pin_mode(Motor_EN, PIN_MODE_OUTPUT);   //使能电机驱动引脚   PB14
+    rt_pin_write(Motor_EN, ON);              //引脚输出高使能有效
+}
+
+
+void motor_zero()
+{
+    rt_pin_mode(Motor_EN, PIN_MODE_OUTPUT); //使能电机驱动引脚   PB14
+    rt_pin_write(Motor_EN, ON);             //引脚输出高使能有效
+
+    rt_pin_mode(CTR_RO_LIMIT, PIN_MODE_OUTPUT);  //CCW  PB15 配置为输出模式
+    rt_pin_mode(CTR_RC_LIMIT, PIN_MODE_OUTPUT);  //CW   PC6  配置为输出模式
+
+    rt_thread_delay(300);
+
+    rt_thread_delay(300);
+
+    rt_pin_mode(Motor_Direction_Button, PIN_MODE_INPUT);   //GET_PIN(B,8)
+    rt_pin_write(CTR_RO_LIMIT, OFF);                   //CCW  back配置
+
+    uint32_t j;
+    for(j=0;j<3200;j++)                          //多配置1600个脉冲,保证肯定能归零;
+    {
+           rt_pin_write(CTR_RC_LIMIT, OFF);
+           rt_thread_delay(PULES);
+           rt_pin_write(CTR_RC_LIMIT, ON);
+           rt_thread_delay(PULES);
+           if( rt_pin_read(Motor_Direction_Button)==0)//判断得到限位信号
+           {
+               rt_thread_delay(5);
+               if( rt_pin_read(Motor_Direction_Button)==0)
+               {
+                   slidelock();
+                   break;
+               }
+           }
+    }
+     rt_thread_delay(300);
+}
+
+
+uint16_t ctr_xmove(uint32_t xdis,uint16_t pulse)
+{
+    //rt_kprintf("run here1");
+    uint32_t j;
+    uint32_t xtemp = 0;
+    xtemp = xdis;                                     //两个脉冲移动0.72度,轴方向上移动2um
+
+    rt_pin_mode(Motor_EN, PIN_MODE_OUTPUT);             //使能电机驱动引脚   PB14
+    rt_pin_write(Motor_EN, ON);                         //引脚输出高使能有效
+
+    rt_pin_mode(CTR_RO_LIMIT, PIN_MODE_OUTPUT);       //CCW  PB15 配置为输出模式
+    rt_pin_mode(CTR_RC_LIMIT, PIN_MODE_OUTPUT);       //CW   PC6  配置为输出模式
+
+
+    //rt_kprintf("run here2");
+    rt_pin_write(CTR_RO_LIMIT, OFF);             //CCW  置高
+    rt_thread_delay(300);
+
+    for(j=0;j<xtemp;j++)
+    {
+        //rt_kprintf("run here4");
+       if((j <= 0.1*xtemp))
+       {
+           //rt_kprintf("run here5");
+           //rt_kprintf("xtemp is %d",xtemp );
+            rt_pin_write(CTR_RC_LIMIT, OFF);
+            //rt_kprintf("run here10");
+            //rt_kprintf("pulse is %d",pulse);
+            //rt_thread_delay(1);  //前10%以线性加速运动
+            rt_hw_us_delay(pulse*(0.1*xtemp - j + 20)/20);  //前10%以线性加速运动
+            rt_pin_write(CTR_RC_LIMIT, ON);
+            //rt_kprintf("run here11");
+            //rt_thread_delay(1);
+            rt_hw_us_delay(pulse*(0.1*xtemp - j + 20)/20);
+            //rt_kprintf("run here9");
+       }
+       if((j >0.1*xtemp)&&(j <= 0.9*xtemp))
+       {
+           //rt_kprintf("run here6");
+             rt_pin_write(CTR_RC_LIMIT, OFF);
+             rt_hw_us_delay(pulse);
+             rt_pin_write(CTR_RC_LIMIT, ON);
+             rt_hw_us_delay(pulse);
+        }
+        if((j > 0.9*xtemp))
+        {
+            //rt_kprintf("run here7");
+             rt_pin_write(CTR_RC_LIMIT, OFF);
+             rt_hw_us_delay(pulse*(j-0.9*xtemp + 20)/20);  //后10%以线性减速运动
+             rt_pin_write(CTR_RC_LIMIT, ON);
+             rt_hw_us_delay(pulse*(j-0.9*xtemp + 20)/20);
+        }
+        //rt_kprintf("run here8");
+     }
+     slidelock();
+     return xdis;
+ }
 
 /*
  * 灯管

+ 1 - 1
Application_cbd_apm32f1/applications/control.h

@@ -317,7 +317,7 @@ void HardWare_Check(uint8_t boot);              //自检
 void ResetInit(void);                           //上电复位
 void SunTest(void);                             //光控测试
 /*****************************************************/
-
+uint16_t ctr_xmove(uint32_t xdis,uint16_t pulse);
 /***********************孢子仪****************************/
 
 /***************************************************/

+ 6 - 4
Application_cbd_apm32f1/applications/hmi.c

@@ -1296,15 +1296,17 @@ static void HMI_Decode(void)
         _485_play(sound122, 4);
         HMI_WRITE("sysTest.result.txt=\"害虫测试!\"");
         ctr_Motor_Driver_Power(ON);
+        ctr_xmove(400,200);//旋转清虫
         //使用硬件定时器控制
-        device_status.autotakepic = 10;
+        //device_status.autotakepic = 10;
 
     }else if(strstr(rx_buffer,"yichong")!=NULL)
     {
         _485_play(sound122, 4);
         HMI_WRITE("sysTest.result.txt=\"益虫测试!\"");
         ctr_Motor_Driver_Power(ON);
-        device_status.autotakepic = 11;
+        ctr_xmove(400,200);//旋转清虫
+        //device_status.autotakepic = 11;
     }
 }
 
@@ -1556,12 +1558,12 @@ static void Ctr_Mortor_entry(void* parameter)
             ef_set_env_blob("run_sta", &device_status.run_sta, sizeof(device_status.run_sta));
          }
         else if (device_status.autotakepic==10) {
-            hwtimer2_pwm3_output(1,20000,1,0);
+            hwtimer2_pwm3_output(1,10000,1,0);
             device_status.autotakepic = 0;
         }
 
         else if (device_status.autotakepic==11) {
-            hwtimer2_pwm3_output(1,20000,1,1);
+            hwtimer2_pwm3_output(1,10000,1,1);
             device_status.autotakepic = 0;
         }