|
@@ -470,26 +470,7 @@ static void HMI_Decode(char *cmd,uint8_t cmd_len)
|
|
|
ctr_Cool_Fan(OFF);
|
|
ctr_Cool_Fan(OFF);
|
|
|
LOG_I("散热风机已关闭!");
|
|
LOG_I("散热风机已关闭!");
|
|
|
}
|
|
}
|
|
|
- //步进上行开始
|
|
|
|
|
- else if(strstr(rx_buffer,"putTest.switchUp=1")!=NULL){
|
|
|
|
|
- ctr_Motor_Driver(1, 0,500000,200);
|
|
|
|
|
- LOG_I("开始步进上行!");
|
|
|
|
|
- }
|
|
|
|
|
- //步进上行停止
|
|
|
|
|
- else if(strstr(rx_buffer,"putTest.switchUp=0")!=NULL){
|
|
|
|
|
- ctr_Motor_Driver(0, 0,0,0);
|
|
|
|
|
- LOG_I("停止步进上行!");
|
|
|
|
|
- }
|
|
|
|
|
- //步进下行
|
|
|
|
|
- else if(strstr(rx_buffer,"putTest.switchDown=1")!=NULL){
|
|
|
|
|
- ctr_Motor_Driver(1, 1,500000,200);
|
|
|
|
|
- rt_kprintf("开始步进下行!\n");
|
|
|
|
|
- }
|
|
|
|
|
- //步进下行停止
|
|
|
|
|
- else if(strstr(rx_buffer,"putTest.switchDown=0")!=NULL){
|
|
|
|
|
- ctr_Motor_Driver(0, 0,0,0);
|
|
|
|
|
- rt_kprintf("停止步进下行!\n");
|
|
|
|
|
- }
|
|
|
|
|
|
|
+
|
|
|
//开始对焦拍照
|
|
//开始对焦拍照
|
|
|
else if(strstr(rx_buffer,"putTest.switchAutopic=1")!=NULL){
|
|
else if(strstr(rx_buffer,"putTest.switchAutopic=1")!=NULL){
|
|
|
device_status.autotakepic=1;
|
|
device_status.autotakepic=1;
|
|
@@ -592,27 +573,66 @@ static void HMI_Decode(char *cmd,uint8_t cmd_len)
|
|
|
}
|
|
}
|
|
|
//打开上仓门
|
|
//打开上仓门
|
|
|
else if(strstr(rx_buffer,"putTest.switchUp=1")!=NULL){
|
|
else if(strstr(rx_buffer,"putTest.switchUp=1")!=NULL){
|
|
|
- rt_kprintf("Open UP!\n");
|
|
|
|
|
- ctr_cangmen_up(OFF);
|
|
|
|
|
- device_status.ctr_up_motor = 1;
|
|
|
|
|
|
|
+ if(device_status.dtype==7)
|
|
|
|
|
+ {
|
|
|
|
|
+ ctr_lamp(ON, 1);
|
|
|
|
|
+ ctr_Motor_Driver(1, 0,500000,300);
|
|
|
|
|
+ LOG_I("开始步进上行!");
|
|
|
|
|
+ }
|
|
|
|
|
+ else
|
|
|
|
|
+ {
|
|
|
|
|
+ rt_kprintf("Open UP!\n");
|
|
|
|
|
+ ctr_cangmen_up(OFF);
|
|
|
|
|
+ device_status.ctr_up_motor = 1;
|
|
|
|
|
+ }
|
|
|
}
|
|
}
|
|
|
//关闭上仓门
|
|
//关闭上仓门
|
|
|
else if(strstr(rx_buffer,"putTest.switchUp=0")!=NULL){
|
|
else if(strstr(rx_buffer,"putTest.switchUp=0")!=NULL){
|
|
|
- rt_kprintf("CLOSE UP!\n");
|
|
|
|
|
- ctr_cangmen_up(OFF);
|
|
|
|
|
- device_status.ctr_up_motor = 2;
|
|
|
|
|
|
|
+ if(device_status.dtype==7)
|
|
|
|
|
+ {
|
|
|
|
|
+ ctr_lamp(OFF, 0);
|
|
|
|
|
+ ctr_Motor_Driver(0, 0,0,0);
|
|
|
|
|
+ LOG_I("停止步进上行!");
|
|
|
|
|
+ }
|
|
|
|
|
+ else
|
|
|
|
|
+ {
|
|
|
|
|
+ rt_kprintf("CLOSE UP!\n");
|
|
|
|
|
+ ctr_cangmen_up(OFF);
|
|
|
|
|
+ device_status.ctr_up_motor = 2;
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
}
|
|
}
|
|
|
//打开下仓门
|
|
//打开下仓门
|
|
|
else if(strstr(rx_buffer,"putTest.switchDown=1")!=NULL){
|
|
else if(strstr(rx_buffer,"putTest.switchDown=1")!=NULL){
|
|
|
- ctr_cangmen_down(OFF);
|
|
|
|
|
- device_status.ctr_down_motor = 1;
|
|
|
|
|
- rt_kprintf("Open down!\n");
|
|
|
|
|
|
|
+ if(device_status.dtype==7)
|
|
|
|
|
+ {
|
|
|
|
|
+ ctr_lamp(ON, 1);
|
|
|
|
|
+ ctr_Motor_Driver(1, 1,500000,300);
|
|
|
|
|
+ rt_kprintf("开始步进下行!\n");
|
|
|
|
|
+ }
|
|
|
|
|
+ else
|
|
|
|
|
+ {
|
|
|
|
|
+ ctr_cangmen_down(OFF);
|
|
|
|
|
+ device_status.ctr_down_motor = 1;
|
|
|
|
|
+ rt_kprintf("Open down!\n");
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
}
|
|
}
|
|
|
//关闭下仓门
|
|
//关闭下仓门
|
|
|
else if(strstr(rx_buffer,"putTest.switchDown=0")!=NULL){
|
|
else if(strstr(rx_buffer,"putTest.switchDown=0")!=NULL){
|
|
|
- ctr_cangmen_down(OFF);
|
|
|
|
|
- device_status.ctr_down_motor = 2;
|
|
|
|
|
- rt_kprintf("CLOSE down!\n");
|
|
|
|
|
|
|
+ if(device_status.dtype==7)
|
|
|
|
|
+ {
|
|
|
|
|
+ ctr_lamp(OFF, 0);
|
|
|
|
|
+ ctr_Motor_Driver(0, 0,0,0);
|
|
|
|
|
+ rt_kprintf("停止步进下行!\n");
|
|
|
|
|
+ }
|
|
|
|
|
+ else
|
|
|
|
|
+ {
|
|
|
|
|
+ ctr_cangmen_down(OFF);
|
|
|
|
|
+ device_status.ctr_down_motor = 2;
|
|
|
|
|
+ rt_kprintf("CLOSE down!\n");
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
}
|
|
}
|
|
|
//定时设置
|
|
//定时设置
|
|
|
else if (strstr(rx_buffer,"saveClockSet=")!=NULL) {
|
|
else if (strstr(rx_buffer,"saveClockSet=")!=NULL) {
|
|
@@ -1278,10 +1298,12 @@ static void Ctr_Mortor_entry(void* parameter)
|
|
|
if(device_status.autotakepic==1)
|
|
if(device_status.autotakepic==1)
|
|
|
{
|
|
{
|
|
|
DTU_Write("autotakephoto");
|
|
DTU_Write("autotakephoto");
|
|
|
|
|
+ //打开步进电机驱动器电源
|
|
|
|
|
+ ctr_lamp(ON, 1);
|
|
|
//打开补光灯
|
|
//打开补光灯
|
|
|
ctr_led(ON);
|
|
ctr_led(ON);
|
|
|
//电机向下运动
|
|
//电机向下运动
|
|
|
- ctr_Motor_Driver(1, 1, 500000,200);
|
|
|
|
|
|
|
+ ctr_Motor_Driver(1, 1, 500000,300);
|
|
|
rt_thread_delay(1000);
|
|
rt_thread_delay(1000);
|
|
|
LOG_I("电机到达下方!!!");
|
|
LOG_I("电机到达下方!!!");
|
|
|
Hk_Take_io();
|
|
Hk_Take_io();
|
|
@@ -1292,11 +1314,8 @@ static void Ctr_Mortor_entry(void* parameter)
|
|
|
beep_set(500000, 500000/5); //2kzh - 50%
|
|
beep_set(500000, 500000/5); //2kzh - 50%
|
|
|
while(rt_pin_read(LIMIT_UP)==1)
|
|
while(rt_pin_read(LIMIT_UP)==1)
|
|
|
{
|
|
{
|
|
|
- rt_thread_delay(10);
|
|
|
|
|
- photo_setup++;
|
|
|
|
|
rt_pin_write(Motor_EN, 0); //驱动器失能
|
|
rt_pin_write(Motor_EN, 0); //驱动器失能
|
|
|
Hk_Take_io();
|
|
Hk_Take_io();
|
|
|
- rt_thread_delay(1000);
|
|
|
|
|
rt_pin_write(Motor_EN, 1); //驱动器使能
|
|
rt_pin_write(Motor_EN, 1); //驱动器使能
|
|
|
if(photo_setup>300)
|
|
if(photo_setup>300)
|
|
|
{
|
|
{
|
|
@@ -1307,8 +1326,11 @@ static void Ctr_Mortor_entry(void* parameter)
|
|
|
HMI_WRITE("sysTest.switchAutopic.val=%d",0);
|
|
HMI_WRITE("sysTest.switchAutopic.val=%d",0);
|
|
|
break;
|
|
break;
|
|
|
}
|
|
}
|
|
|
|
|
+ photo_setup++;
|
|
|
|
|
+ rt_thread_mdelay(100);
|
|
|
LOG_I("对焦拍照:%d",photo_setup);
|
|
LOG_I("对焦拍照:%d",photo_setup);
|
|
|
}
|
|
}
|
|
|
|
|
+ DTU_Write("takephotodone");
|
|
|
ctr_led(OFF);
|
|
ctr_led(OFF);
|
|
|
rt_pin_write(Motor_EN, 0); //驱动器失能
|
|
rt_pin_write(Motor_EN, 0); //驱动器失能
|
|
|
beep_set(500000, 0); //2kzh - 50%
|
|
beep_set(500000, 0); //2kzh - 50%
|
|
@@ -1321,7 +1343,8 @@ static void Ctr_Mortor_entry(void* parameter)
|
|
|
device_status.autotakepic=0;
|
|
device_status.autotakepic=0;
|
|
|
photo_setup = 0;
|
|
photo_setup = 0;
|
|
|
HMI_WRITE("sysTest.switchAutopic.val=%d",0);
|
|
HMI_WRITE("sysTest.switchAutopic.val=%d",0);
|
|
|
- DTU_Write("takephotodone");
|
|
|
|
|
|
|
+ //关闭步进电机驱动器电源
|
|
|
|
|
+ ctr_lamp(OFF, 0);
|
|
|
}
|
|
}
|
|
|
if(device_status.fsl_sw==1)
|
|
if(device_status.fsl_sw==1)
|
|
|
{
|
|
{
|