87 lines
1.7 KiB
C
87 lines
1.7 KiB
C
|
|
|||
|
|
//-------------------------------------------------------------------------------
|
|||
|
|
// File Name: workctrl.c
|
|||
|
|
// Brief:
|
|||
|
|
// Version: 1.0.0
|
|||
|
|
// Create Date: 2018/03/19
|
|||
|
|
// Create by: Marshal Lee
|
|||
|
|
// Copyright:
|
|||
|
|
// Copyright (c) 2017, Richpeace Co., LTD.
|
|||
|
|
// All rights reserved.
|
|||
|
|
//
|
|||
|
|
// Modify by: Marshal Lee
|
|||
|
|
// Modify Date: 2018/03/19
|
|||
|
|
//-------------------------------------------------------------------------------
|
|||
|
|
|
|||
|
|
#define _IN_WORKCTRL_C
|
|||
|
|
|
|||
|
|
#include "workctrl.h"
|
|||
|
|
|
|||
|
|
#include "inout.h"
|
|||
|
|
#include "shell.h"
|
|||
|
|
#include "delay.h"
|
|||
|
|
#include "trigger.h"
|
|||
|
|
#include "funcs.h"
|
|||
|
|
#include "sewhead.h"
|
|||
|
|
#include "debug.h"
|
|||
|
|
|
|||
|
|
//-------------------------------------------------------------------------------
|
|||
|
|
|
|||
|
|
|
|||
|
|
//-------------------------------------------------------------------------------
|
|||
|
|
|
|||
|
|
void InitWorkCtrl(void)
|
|||
|
|
{
|
|||
|
|
DelayMs(1000);
|
|||
|
|
|
|||
|
|
memset(&g_workCtrl, 0, sizeof(WorkCtrl));
|
|||
|
|
g_workCtrl.workSta = 1;
|
|||
|
|
|
|||
|
|
#if (BOARD_USE_FOR == SEW_HEAD)
|
|||
|
|
InitSewHeadBoard();
|
|||
|
|
#endif
|
|||
|
|
|
|||
|
|
#if (CONTROL_BUS == COMM_CAN)
|
|||
|
|
InitCAN();
|
|||
|
|
#endif
|
|||
|
|
InitDebug();
|
|||
|
|
//printf("Init work finish.\r\n");
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
//-------------------------------------------------------------------------------
|
|||
|
|
|
|||
|
|
void DelayRef(u32 ms)
|
|||
|
|
{
|
|||
|
|
while(ms != 0)
|
|||
|
|
{
|
|||
|
|
TriggerTask(); // <20><>ʱ<EFBFBD><CAB1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ִ<EFBFBD>У<EFBFBD>TCP <20><><EFBFBD>ӣ<EFBFBD><D3A3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
|||
|
|
//CanBusTask(); // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ִ<EFBFBD><D6B4>
|
|||
|
|
DelayMs(1);
|
|||
|
|
ms--;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
//-------------------------------------------------------------------------------
|
|||
|
|
|
|||
|
|
void WorkCtrlTask(void)
|
|||
|
|
{
|
|||
|
|
#if (BOARD_USE_FOR == SEW_HEAD)
|
|||
|
|
SewHeadBoardTask();
|
|||
|
|
#endif
|
|||
|
|
#if (CONTROL_BUS == COMM_CAN)
|
|||
|
|
CanBusTask();
|
|||
|
|
#endif
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
//-------------------------------------------------------------------------------
|
|||
|
|
|
|||
|
|
//-------------------------------------------------------------------------------
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|