|
|
@@ -553,420 +553,7 @@ void SunTest(void)
|
|
|
}
|
|
|
HMI_WRITE("sysTest.switchSun.val=%d",0);
|
|
|
}
|
|
|
-//读取上仓门电机功耗
|
|
|
-void ReadUpMotorPower(uint16_t timeout)
|
|
|
-{
|
|
|
- if(timeout>100||timeout < 0)
|
|
|
- {
|
|
|
- return;
|
|
|
- }
|
|
|
- HardWare_Init(0);
|
|
|
- //读取上仓门功耗***************************************************************
|
|
|
- if(device_status.up_status==1)
|
|
|
- {
|
|
|
- device_status.ctr_up_motor = 2; //关闭上仓门
|
|
|
- }
|
|
|
- else {
|
|
|
- device_status.ctr_up_motor = 1; //打开
|
|
|
- }
|
|
|
- //等待5s
|
|
|
- rt_kprintf("开始读取上仓门电流......\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"开始读取上仓门电流...\"");
|
|
|
- //当前功耗小于待机功耗+100,大于待机功耗-100,说明镇流器还未工作,阻塞至此,10s超时
|
|
|
- while((atoi(device_status.power)<device_status.sleep_p+100)&&(atoi(device_status.power)>device_status.sleep_p-100))
|
|
|
- {
|
|
|
- timeout++;
|
|
|
- rt_thread_delay(500);
|
|
|
- rt_kprintf("正在读取上仓门电机电流...");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"正在读取上仓门电机电流...\"");
|
|
|
- if(timeout==20)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- timeout = 0;
|
|
|
-
|
|
|
- device_status.up_motor_p = atoi(device_status.power);
|
|
|
- rt_kprintf("上仓门电流:%d\n",device_status.up_motor_p);
|
|
|
- ef_set_env_blob("up_motor_power", &device_status.up_motor_p, sizeof(device_status.up_motor_p));
|
|
|
- HMI_WRITE("hardcheck.up_motor_p.val=%d",device_status.up_motor_p); //减去屏幕的功耗才是待机功耗
|
|
|
- //当前电流大于待机电流+100,上仓门电机还未停止
|
|
|
- while(atoi(device_status.power)>device_status.sleep_p+100)
|
|
|
- {
|
|
|
- timeout++;
|
|
|
- rt_thread_delay(500);
|
|
|
- rt_kprintf("正在等待上仓门电机停止...");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"正在等待上仓门电机停止...\"");
|
|
|
- if(timeout==20)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"上仓门电机停止!!!\"");
|
|
|
-}
|
|
|
-//读取下仓门电机功耗
|
|
|
-void ReadDownMotorPower(uint16_t timeout)
|
|
|
-{
|
|
|
- if(timeout>100||timeout < 0)
|
|
|
- {
|
|
|
- return;
|
|
|
- }
|
|
|
- HardWare_Init(0);
|
|
|
- //读取下仓门功耗***************************************************************
|
|
|
- if(device_status.down_status == 1)
|
|
|
- {
|
|
|
- device_status.ctr_down_motor = 2;
|
|
|
- }
|
|
|
- else {
|
|
|
- device_status.ctr_down_motor = 1;
|
|
|
- }
|
|
|
- //等待5s
|
|
|
- rt_kprintf("开始读取下仓门电流......\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"开始读取下仓门电流...\"");
|
|
|
- //当前功耗小于待机功耗+100,大于待机功耗-100,说明镇流器还未工作,阻塞至此,10s超时
|
|
|
- while((atoi(device_status.power)<device_status.sleep_p+100)&&(atoi(device_status.power)>device_status.sleep_p-100))
|
|
|
- {
|
|
|
- timeout ++;
|
|
|
- rt_thread_delay(500);
|
|
|
- rt_kprintf("正在读取下仓门电流...");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"正在读取下仓门电流...\"");
|
|
|
- if(timeout==20)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- device_status.down_motor_p = atoi(device_status.power);
|
|
|
- rt_kprintf("下仓门电流:%d\n",device_status.down_motor_p);
|
|
|
- HMI_WRITE("hardcheck.down_motor_p.val=%d",device_status.down_motor_p); //减去屏幕的功耗才是待机功耗
|
|
|
- ef_set_env_blob("down_motor_power", &device_status.down_motor_p, sizeof(device_status.down_motor_p));
|
|
|
- timeout = 0;
|
|
|
- //当前电流大于待机电流+100,上仓门电机还未停止
|
|
|
- while(atoi(device_status.power)>device_status.sleep_p+100)
|
|
|
- {
|
|
|
- timeout++;
|
|
|
- rt_thread_delay(500);
|
|
|
- rt_kprintf("正在等待下仓门电机停止...");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"正在等待下仓门电机停止...\"");
|
|
|
- if(timeout==20)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- timeout = 0;
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"下仓门电机已停止!!!\"");
|
|
|
-}
|
|
|
-//读取清扫电机功耗
|
|
|
-void ReadClearMortorPower(uint16_t timeout)
|
|
|
-{
|
|
|
- if(timeout>100||timeout < 0)
|
|
|
- {
|
|
|
- return;
|
|
|
- }
|
|
|
- HardWare_Init(0);
|
|
|
- //读取清扫电机功耗***************************************************************
|
|
|
- device_status.clear_status = 1;
|
|
|
- //等待5s
|
|
|
- rt_kprintf("开始读取清扫电机电流......\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"开始读取清扫电机电流...\"");
|
|
|
- while((atoi(device_status.power)<device_status.sleep_p+100)&&(atoi(device_status.power)>device_status.sleep_p-100))
|
|
|
- {
|
|
|
- rt_kprintf("正在读取清扫电机电流......\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"正在读取清扫电机电流...\"");
|
|
|
- timeout ++;
|
|
|
- rt_thread_delay(500);
|
|
|
- if(timeout==20)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- device_status.clear_motor_p = atoi(device_status.power);
|
|
|
- rt_kprintf("清扫电机电流:%d\n",device_status.clear_motor_p);
|
|
|
- HMI_WRITE("hardcheck.clear_motor_p.val=%d",device_status.clear_motor_p);
|
|
|
- ef_set_env_blob("clear_motor_power", &device_status.clear_motor_p, sizeof(device_status.clear_motor_p));
|
|
|
- while(device_status.clear_status!=0)
|
|
|
- {
|
|
|
- rt_thread_delay(200);
|
|
|
- rt_kprintf("等待清扫电机停止...");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"等待清扫电机停止...\"");
|
|
|
- }
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"清扫电机已停止!!!\"");
|
|
|
-}
|
|
|
-//读取镇流器功耗
|
|
|
-void ReadLampPower(uint16_t timeout)
|
|
|
-{
|
|
|
- if(timeout>100||timeout < 0)
|
|
|
- {
|
|
|
- return;
|
|
|
- }
|
|
|
- HardWare_Init(0);
|
|
|
- ctr_lamp(ON);
|
|
|
- //
|
|
|
- rt_kprintf("开始读取镇流器电流......\n");
|
|
|
- while((atoi(device_status.power)<device_status.sleep_p+100)&&(atoi(device_status.power)>device_status.sleep_p-100))
|
|
|
- {
|
|
|
- rt_kprintf("正在读取镇流器电流......\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"正在读取镇流器电流...\"");
|
|
|
- timeout ++;
|
|
|
- rt_thread_delay(500);
|
|
|
- if(timeout==20)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- timeout = 0;
|
|
|
- if(device_status.lamp_status==1)
|
|
|
- {
|
|
|
- device_status.lamp_p = atoi(device_status.power);
|
|
|
- rt_kprintf("镇流器电流:%d\n",device_status.lamp_p);
|
|
|
- HMI_WRITE("hardcheck.lamp_p.val=%d",device_status.lamp_p);
|
|
|
- ef_set_env_blob("lamp_power", &device_status.lamp_p, sizeof(device_status.lamp_p));
|
|
|
- }
|
|
|
- ctr_lamp(OFF);
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"镇流器已关闭!!!\"");
|
|
|
-}
|
|
|
-//读取补光灯功耗
|
|
|
-void ReadLedPower(uint16_t timeout)
|
|
|
-{
|
|
|
- if(timeout>100||timeout < 0)
|
|
|
- {
|
|
|
- return;
|
|
|
- }
|
|
|
- HardWare_Init(0);
|
|
|
- ctr_led(ON);
|
|
|
- rt_kprintf("开始读取补光灯电流......\n");
|
|
|
- while((atoi(device_status.power)<device_status.sleep_p+100)&&(atoi(device_status.power)>device_status.sleep_p-100))
|
|
|
- {
|
|
|
- rt_kprintf("正在补光灯电流......\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"正在读取补光灯电流...\"");
|
|
|
- timeout ++;
|
|
|
- rt_thread_delay(500);
|
|
|
- if(timeout==20)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- device_status.led_p = atoi(device_status.power);
|
|
|
- rt_kprintf("补光灯电流:%d\n",device_status.led_p);
|
|
|
- HMI_WRITE("hardcheck.led_p.val=%d",device_status.led_p);
|
|
|
- ef_set_env_blob("led_power", &device_status.led_p, sizeof(device_status.led_p));
|
|
|
- ctr_led(OFF);
|
|
|
- rt_kprintf("关闭补光灯!!!");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"补光灯已关闭!!!\"");
|
|
|
-}
|
|
|
-//读取震动电机
|
|
|
-void ReadShakePower(uint16_t timeout)
|
|
|
-{
|
|
|
- if(timeout>100||timeout < 0)
|
|
|
- {
|
|
|
- return;
|
|
|
- }
|
|
|
- HardWare_Init(0);
|
|
|
- ctr_shake(ON,device_status.shake_sec);
|
|
|
- rt_kprintf("开始读取震动电机电流......\n");
|
|
|
- while((atoi(device_status.power)<device_status.sleep_p+100)&&(atoi(device_status.power)>device_status.sleep_p-100))
|
|
|
- {
|
|
|
- rt_kprintf("正在读取震动电机电流......\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"正在读取震动电机电流...\"");
|
|
|
- timeout ++;
|
|
|
- rt_thread_delay(500);
|
|
|
- if(timeout==20)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- device_status.shake_p = atoi(device_status.power);
|
|
|
- rt_kprintf("震动电机电流:%d\n",device_status.shake_p);
|
|
|
- HMI_WRITE("hardcheck.shake_p.val=%d",device_status.shake_p);
|
|
|
- ef_set_env_blob("shake_power", &device_status.shake_p, sizeof(device_status.shake_p));
|
|
|
- ctr_shake(OFF,0);
|
|
|
- rt_kprintf("关闭震动!!!");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"震动已关闭!!!\"");
|
|
|
-}
|
|
|
-//读取加热
|
|
|
-void ReadHeatPower(uint16_t timeout)
|
|
|
-{
|
|
|
- if(timeout>100||timeout < 0)
|
|
|
- {
|
|
|
- return;
|
|
|
- }
|
|
|
- HardWare_Init(0);
|
|
|
- ctr_Heat(ON);
|
|
|
- rt_kprintf("开始读取加热带电流......\n");
|
|
|
- while((atoi(device_status.power)<device_status.sleep_p+100)&&(atoi(device_status.power)>device_status.sleep_p-100))
|
|
|
- {
|
|
|
- rt_kprintf("正在读取加热带电流......\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"正在读取加热带电流...\"");
|
|
|
- timeout ++;
|
|
|
- rt_thread_delay(500);
|
|
|
- if(timeout==20)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- device_status.heat_p = atoi(device_status.power);
|
|
|
- rt_kprintf("加热带电流:%d\n",device_status.heat_p);
|
|
|
- HMI_WRITE("hardcheck.heat_p.val=%d",device_status.heat_p);
|
|
|
- ef_set_env_blob("led_power", &device_status.heat_p, sizeof(device_status.heat_p));
|
|
|
- ctr_Heat(OFF);
|
|
|
- rt_kprintf("关闭加热带!!!\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"加热带已关闭!!!\"");
|
|
|
-}
|
|
|
-//读取路由器
|
|
|
-void ReadRouterPower(uint16_t timeout)
|
|
|
-{
|
|
|
- if(timeout>100||timeout < 0)
|
|
|
- {
|
|
|
- return;
|
|
|
- }
|
|
|
- HardWare_Init(0);
|
|
|
- ctr_router(ON);
|
|
|
- rt_kprintf("开始读取路由器电流......\n");
|
|
|
- while((atoi(device_status.power)<device_status.sleep_p+100)&&(atoi(device_status.power)>device_status.sleep_p-100))
|
|
|
- {
|
|
|
- rt_kprintf("正在读取路由器电流......\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"正在读取路由器电流...\"");
|
|
|
- timeout ++;
|
|
|
- rt_thread_delay(500);
|
|
|
- if(timeout==20)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- timeout = 0;
|
|
|
- device_status.router_p = atoi(device_status.power);
|
|
|
- rt_kprintf("路由器电流:%d\n",device_status.router_p);
|
|
|
- HMI_WRITE("hardcheck.router_p.val=%d",device_status.router_p);
|
|
|
- ef_set_env_blob("router_power", &device_status.router_p, sizeof(device_status.router_p));
|
|
|
- ctr_Heat(OFF);
|
|
|
- rt_kprintf("关闭路由器!!!\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"路由器已关闭!!!\"");
|
|
|
-}
|
|
|
-//读取相机
|
|
|
-void ReadHkPower(uint16_t timeout)
|
|
|
-{
|
|
|
- if(timeout>100||timeout < 0)
|
|
|
- {
|
|
|
- return;
|
|
|
- }
|
|
|
- HardWare_Init(0);
|
|
|
- ctr_photo(ON);
|
|
|
- rt_kprintf("开始读取相机电流......\n");
|
|
|
- while((atoi(device_status.power)<device_status.sleep_p+100)&&(atoi(device_status.power)>device_status.sleep_p-100))
|
|
|
- {
|
|
|
- rt_kprintf("正在读取相机电流......\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"正在读取相机电流...\"");
|
|
|
- timeout ++;
|
|
|
- rt_thread_delay(500);
|
|
|
- if(timeout==20)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- timeout = 0;
|
|
|
- device_status.hk_power = atoi(device_status.power);
|
|
|
- rt_kprintf("相机电流:%d\n",device_status.hk_power);
|
|
|
- HMI_WRITE("hardcheck.photo_p.val=%d",device_status.hk_power);
|
|
|
- ef_set_env_blob("hk_power", &device_status.hk_power, sizeof(device_status.hk_power));
|
|
|
- ctr_photo(OFF);
|
|
|
- rt_kprintf("关闭相机!!!\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"相机已关闭!!!\"");
|
|
|
-}
|
|
|
-//读取RTU/DTU
|
|
|
-void ReadRtuDtuPower(uint16_t timeout)
|
|
|
-{
|
|
|
- if(timeout>100||timeout < 0)
|
|
|
- {
|
|
|
- return;
|
|
|
- }
|
|
|
- HardWare_Init(0);
|
|
|
- ctr_RTU_DTU(ON);
|
|
|
- rt_kprintf("开始读RTU电流......\n");
|
|
|
- while((atoi(device_status.power)<device_status.sleep_p+100)&&(atoi(device_status.power)>device_status.sleep_p-100))
|
|
|
- {
|
|
|
- rt_kprintf("正在读取RTU电流......\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"正在读取RTU电流...\"");
|
|
|
- timeout ++;
|
|
|
- rt_thread_delay(500);
|
|
|
- if(timeout==20)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- timeout = 0;
|
|
|
- device_status.rtu_dtu_p = atoi(device_status.power);
|
|
|
- rt_kprintf("RTU12V电流:%d\n",device_status.rtu_dtu_p);
|
|
|
- HMI_WRITE("hardcheck.rtu_p.val=%d",device_status.rtu_dtu_p);
|
|
|
- ef_set_env_blob("rtu_power", &device_status.rtu_dtu_p, sizeof(device_status.rtu_dtu_p));
|
|
|
- ctr_photo(OFF);
|
|
|
- rt_kprintf("关闭RTU12V!!!\n");
|
|
|
- HMI_WRITE("hardcheck.checktip.txt=\"RTU12V已关闭!!!\"");
|
|
|
-}
|
|
|
-//读待机功耗
|
|
|
-void ReadSleepPower(uint8_t boot)
|
|
|
-{
|
|
|
- HardWare_Init(boot);
|
|
|
- device_status.sleep_p = atoi(device_status.power);
|
|
|
- if(device_status.sleep_p>100)
|
|
|
- {
|
|
|
- device_status.sleep_p = device_status.sleep_p - 60; //减去屏幕的功耗才是待机功耗
|
|
|
- }
|
|
|
- rt_kprintf("待机电流:%d\n",device_status.sleep_p);
|
|
|
- //保存待机功耗到Flash
|
|
|
- ef_set_env_blob("sleep_power", &device_status.sleep_p, sizeof(device_status.sleep_p));
|
|
|
- HMI_WRITE("hardcheck.sleep_p.val=%d",device_status.sleep_p);
|
|
|
-}
|
|
|
-//
|
|
|
-void CheckRead_Power(void)
|
|
|
-{
|
|
|
-/////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- ReadSleepPower(1); //1.待机
|
|
|
- HMI_WRITE("hardcheck.tip_num.val=%d",5);
|
|
|
- rt_thread_delay(1000);
|
|
|
-//////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- ReadRouterPower(0); //2.路由器
|
|
|
- rt_thread_delay(1000);
|
|
|
- HMI_WRITE("hardcheck.tip_num.val=%d",10);
|
|
|
-/////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- ReadHkPower(0); //3.相机
|
|
|
- rt_thread_delay(1000);
|
|
|
- HMI_WRITE("hardcheck.tip_num.val=%d",20);
|
|
|
-////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- ReadLampPower(0); //4.打开镇流器
|
|
|
- rt_thread_delay(1000);
|
|
|
- HMI_WRITE("hardcheck.tip_num.val=%d",30);
|
|
|
-//////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- ReadUpMotorPower(0); //5.打开上仓门
|
|
|
- rt_thread_delay(1000);
|
|
|
- HMI_WRITE("hardcheck.tip_num.val=%d",40);
|
|
|
-//////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- ReadDownMotorPower(0); //6.关闭下仓门
|
|
|
- rt_thread_delay(1000);
|
|
|
- HMI_WRITE("hardcheck.tip_num.val=%d",50);
|
|
|
-/////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- ReadHeatPower(0); //7.加热带
|
|
|
- rt_thread_delay(1000);
|
|
|
- HMI_WRITE("hardcheck.tip_num.val=%d",60);
|
|
|
-////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- ReadClearMortorPower(0); //8.清扫
|
|
|
- rt_thread_delay(1000);
|
|
|
- HMI_WRITE("hardcheck.tip_num.val=%d",70);
|
|
|
-////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- ReadShakePower(0); //9.震动
|
|
|
- rt_thread_delay(1000);
|
|
|
- HMI_WRITE("hardcheck.tip_num.val=%d",80);
|
|
|
-//////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- ReadLedPower(0); //10.补光灯
|
|
|
- rt_thread_delay(1000);
|
|
|
- HMI_WRITE("hardcheck.tip_num.val=%d",90);
|
|
|
-/////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
- ReadRtuDtuPower(0); //11.外接12V供电,(路由器/海康相机/RTU/DTU)
|
|
|
- rt_thread_delay(1000);
|
|
|
- HMI_WRITE("hardcheck.tip_num.val=%d",100);
|
|
|
|
|
|
-////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
|
-
|
|
|
-}
|
|
|
/*上电初始化*/
|
|
|
void ResetInit(void)
|
|
|
{
|
|
|
@@ -1039,8 +626,6 @@ void HardWare_Check(uint8_t boot)
|
|
|
//打开补光灯,读取功率值保存
|
|
|
//打开路由器/RTU供电,读取功率值保存
|
|
|
//打开加热,读取功率值保存
|
|
|
- CheckRead_Power();
|
|
|
-
|
|
|
}
|
|
|
|
|
|
}
|