#define _IN_WORKCTRL_C

#include "workctrl.h"

#include "movectrl.h"
#include "error.h"
#include "buttons.h"
#include "inout.h"
#include "shell.h"
#include "debug.h"
#include "trigger.h"
#include "delay.h"
#include "canctrl.h"
#include "extendboards.h"
#include "ethernet.h"
#include "filetrans.h"
#include "installment.h"

//------------------------------------------------------------------------------- 

void OneMinTimerTask(void);

//-------------------------------------------------------------------------------


#if (AUTO_ELEC_CLIP == 1)
// 电子夹线器区间等级表.
	// 0~239 存放120个区间等级
	// 其中偶数index中存放的起始索引,奇数为终止索引.
	// 起始索引中的level存放夹线力度.终止索引中的level始终为零.

	// 240,241 存放结束符,默认为0

	// 254,255存放默认等级和夹线力度

DataClip g_dataClipLvBuf[256];
#endif

//-------------------------------------------------------------------------------

#define EXEC_WORK_FUNC(func)	\
do \
{ \
	if (func != NULL) \
	{ \
		func(); \
	} \
}while(0)


//-------------------------------------------------------------------------------

void InitWorkCtrl(void)
{
	memset(&g_workCtrl, 0, sizeof(WorkCtrl));

	g_workCtrl.embMendEndIdx = -1;			// 20220303增加此初始化

#if (1)			// 暂时允许工作......
	g_workCtrl.cursta.workStatus |= WORK_STA_ENTIME;
	g_workCtrl.cursta.workStatus |= WORK_STA_ENSTATE;
#endif

	// 装载保存数据
#if (1)
	printf("sizeof(SavedPara)=%d\r\n", sizeof(SavedPara));
	ReadNVPara((NVPara*)(&g_workCtrl.savedpara), 1);	// 装载保存数据

	if (g_workCtrl.savedpara.mcType != MC_TYPE)
	{
		g_workCtrl.savedpara.enFlag = 0;
	}

	if (g_workCtrl.savedpara.enFlag != NVPARA_EN)
	{
		memset(&g_workCtrl.savedpara, 0, sizeof(g_workCtrl.savedpara));

		g_workCtrl.savedpara.mcType = MC_TYPE;
		g_workCtrl.savedpara.enFlag = NVPARA_EN;
		SaveWorkNvPara();

		printf("2. load save data failed\r\n");
		g_workCtrl.posEnFlag = 0;	// 电机位置失效
	}
	else
	{
		u32 address;
		address = (u32)(&(g_workCtrl.savedpara.motospos[0]));
		SetMotosCounter((s32 *)(address));		// 设置电机位置
		ReadAndFreshMotosPos();
		g_workCtrl.posEnFlag = ALL_MOTO_MOD;				// 电机位置有效

		g_workCtrl.cursta.dataIdx = g_workCtrl.savedpara.dataIdx;			// 装载数据索引
		printf("load fileID=0x%x, dataIdx=%d\r\n", g_workCtrl.savedpara.fileID, g_workCtrl.cursta.dataIdx);

		g_workCtrl.cursta.runSteps = g_workCtrl.savedpara.runSteps;			// 装载运行步骤
		g_workCtrl.cursta.outCounter = g_workCtrl.savedpara.outCounter;		// 装载产量计数
		g_workCtrl.cursta.embNeedleNum = g_workCtrl.savedpara.embNeedleNum;	// 装载刺绣针数
		g_workCtrl.cursta.btrdPics = g_workCtrl.savedpara.btrdPics;			// 装载底线片数计数
		g_workCtrl.cursta.btrdLength = g_workCtrl.savedpara.btrdLength;		// 装载底线长度计数
		g_workCtrl.cursta.fileIdx = g_workCtrl.savedpara.fileIdx;			// 装载文件序号
		g_datFile.fileIdx = g_workCtrl.cursta.fileIdx;						// 装载文件序号
		g_datFile.fileIdxMap = g_workCtrl.savedpara.fileIdxMap;				// 装载文件位图

		printf("2. load save data success\r\n");
	}
#endif

	InitAppCallback();

	InitDebug();

	{
		int rslt;
		rslt = InitInstallment();		// 初始化加密
		if (rslt != 0)	// 已经减去了关机时间
		{
			g_workCtrl.cansetelapsed = 1; // 设置不再接收上位机关机时间命令
		}
		RefreshWorkTimeEn();

		AddTriggerToList(60000, NULL, OneMinTimerTask);			// 1分钟定时任务，工作时间计数
	}
}

__WEAK void InitAppCallback(void)
{
}

void WorkCtrlTask(void)
{
	EXEC_WORK_FUNC(g_workCtrl.WorkRunTask);
	EXEC_WORK_FUNC(g_workCtrl.AsynchronousTask);
}

void TasksWhenDelay(void)
{
	EXEC_WORK_FUNC(g_workCtrl.AsynchronousTask);
	TriggerTask();			// 定时触发任务执行
	ExtendBoardTask();		// 输入输出任务执行
}

void DelayRef(u32 ms)
{
	do
	{
		TasksWhenDelay();

		if (ms <= 0)
		{
			break;
		}
		DelayMs(1);
		ms--;
	}while(1);
}

void DelayRefFt(u32 ms)
{
	u32 us = 0;
	do
	{
		TasksWhenDelay();
		if (ms <= 0)
		{
			break;
		}
		DelayUs(100);
		us++;
		if(us >= 10)
		{
			us = 0;
			ms--;
		}
	}while(1);
}

// 延时同时执行异步任务
void DelayAndAsyncExe(u32 ms)
{
	u32 timb = GetMsSoftTimer();
	do
	{
		TasksWhenDelay();

		u32 tim = GetMsSoftTimer();
		if (tim - timb >= ms)
		{
			break;
		}

	}while(1);
}

//-------------------------------------------------------------------------------

// 1分钟定时任务
void OneMinTimerTask(void)
{
	RefWorkableTimer(-1);		// 每分钟，计时减少

	RefreshWorkTimeEn();		// 更新允许工作标志
}

void RefreshWorkTimeEn(void)
{
#if	(USE_PASSWORD == 1)	// 强制使用分期付款密码
	if (GetWorkableTime() <= 0)
	{
		g_workCtrl.cursta.workStatus &= ~(WORK_STA_ENTIME);		// 禁止工作(时间)
	}
	else
	{
		g_workCtrl.cursta.workStatus |= WORK_STA_ENTIME;		// 允许工作(时间)
	}
#elif (USE_PASSWORD == 2)	// 如果设置过分期付款密码,则按密码执行,否则认为没有密码
	u8 paswd[24];
	int i;

	GetLastpswd(paswd);
	for (i=0;i<24;i++)
	{
		if (paswd[i] != 0)
		{
			break;
		}
	}

	if (i != 24)
	{// 设置过分期密码
		if (GetWorkableTime() <= 0)
		{
			g_workCtrl.cursta.workStatus &= ~(WORK_STA_ENTIME);		// 禁止工作(时间)
		}
		else
		{
			g_workCtrl.cursta.workStatus |= WORK_STA_ENTIME;		// 允许工作(时间)
		}
	}
	else
	{// 没有设置过密码
		g_workCtrl.cursta.workStatus |= WORK_STA_ENTIME;		// 允许工作(时间)
	}

#elif (USE_PASSWORD == 0)	// 不使用密码
	{
		g_workCtrl.cursta.workStatus |= WORK_STA_ENTIME;		// 允许工作(时间)
	}
#endif
}

//-------------------------------------------------------------------------------

void SaveWorkNvPara(void)
{
	SaveNVPara((NVPara*)(&g_workCtrl.savedpara), 1);
}

__WEAK void RefreshStatus(void)
{
}

__WEAK void RefreshParas(int flag)
{
}

// 设置参数有效标志
void SetNewParasFlag(int flag)
{
	g_workCtrl.paraEnFlag |= flag;

	// 参数接收标志
	printf("set para ok flag\r\n");
	g_workCtrl.cursta.workStatus |= WORK_STA_PARAOK;		// 参数接收标志
}

//-------------------------------------------------------------------------------

void RequestBoardVer(void)
{
#if (MAX_SUPPORT_COLOR > 0)
	RequestColorsVersion();
	DelayRef(0);
#endif

#if (MAX_SUPPORT_HEAD > 0)
	RequestHeadsVersion();
	DelayRef(0);
#endif

#if (MAX_SUPPORT_EXTIO > 0)
	RequestExtIOsVersion();
	DelayRef(0);
#endif

}

int CreateBoardVer(OperPacket * pPkt, u8 protocol, u8 nodeId, u8 nodeType, BoardRegVal * pRegVal)
{
	if (pPkt == NULL)
	{
		return -1;
	}

	int rslt;

	memset(pPkt, 0, LEN_NORMAL_PACKET);

	pPkt->sendBoardVer.cmdCode = DCMD_SEND_BOARDVER;
	pPkt->sendBoardVer.protocolType = protocol;
	pPkt->sendBoardVer.nodeType = nodeType;

	if (protocol == BN_PROTOCOL_HEAD)
	{
		pPkt->sendBoardVer.nodeId = nodeId - HEAD_NODEID_BASE + 1;			// 从1开始,上位机不需要知道具体节点ID
	}
	else if (protocol == BN_PROTOCOL_COLOR)
	{
		pPkt->sendBoardVer.nodeId = nodeId - COLOR_NODEID_BASE + 1;			// 从1开始,上位机不需要知道具体节点ID
	}

	memcpy(&pPkt->sendBoardVer.ver, &pRegVal->exbVer, BOARD_VER_LEN*sizeof(u32));

	printf("board version: protocol=%d, nodeid=%d, nodeType=%d\r\n", pPkt->sendBoardVer.protocolType, pPkt->sendBoardVer.nodeId, pPkt->sendBoardVer.nodeType);
	char ver[EX_VER_LEN+1];
	memset(&ver, 0, EX_VER_LEN+1);
	memcpy(&ver, &pPkt->sendBoardVer.ver, BOARD_VER_LEN*sizeof(u32));
	printf("version=%s\r\n", ver);		// 程序版本
	rslt = PacketAVLDP(&(pPkt->packet), (u8*)(&(pPkt->sendBoardVer.ver)), BOARD_VER_LEN*sizeof(u32));
	if (rslt != 0)
	{
		printf("error at call PacketAVLDP in CreateBoardVer\r\n");
	}

	return rslt;
}

int CreateHeadBoardPara(OperPacket * pPkt, u8 nodeId, u8 nodeType, u8* pData)
{
	if (pPkt == NULL || pData == NULL)
	{
		return -1;
	}

	int rslt;

	memset(pPkt, 0, LEN_NORMAL_PACKET);

	pPkt->boardPara.cmdCode = DCMD_SEND_HEADPARA;

	pPkt->boardPara.nodeId = nodeId;			// headList对应索引,上位机不需要知道具体节点ID,只负责存储在相应变量即可
	pPkt->boardPara.nodeType = nodeType;		// 对应节点类型(平绣,毛巾,缠绕)

	memcpy(&pPkt->boardPara.exData, pData, BOARD_PARA_SIZE);

	rslt = PacketAVLDP(&(pPkt->packet), (u8*)(&(pPkt->boardPara.exData)), BOARD_PARA_SIZE);
	if (rslt != 0)
	{
		printf("error at call PacketAVLDP in CreateHeadBoardPara\r\n");
	}

	return rslt;
}

int CreateColorBoardPara(OperPacket * pPkt, u8 nodeId, u8* pData)
{
	if (pPkt == NULL || pData == NULL)
	{
		return -1;
	}

	int rslt;

	memset(pPkt, 0, LEN_NORMAL_PACKET);

	pPkt->boardPara.cmdCode = DCMD_SEND_COLORPARA;

	pPkt->boardPara.nodeId = nodeId;			// 对应索引,上位机不需要知道具体节点ID,只负责存储在相应变量即可

	memcpy(&pPkt->boardPara.exData, pData, BOARD_PARA_SIZE);

	rslt = PacketAVLDP(&(pPkt->packet), (u8*)(&(pPkt->boardPara.exData)), BOARD_PARA_SIZE);
	if (rslt != 0)
	{
		printf("error at call PacketAVLDP in CreateHeadBoardPara\r\n");
	}

	return rslt;
}

int RequestHeadNvParas(int nodetype, int nodeid, int paraid, u32 * pBuf)
{
#if (CUR_MACHINE == MACH_EMB)
	return RequestEmbCoilParasProc(nodeid, pBuf);
#elif (CUR_MACHINE == MACH_WIRE)
	return RequestWireHeadAParaProc(nodeid, 1, paraid, pBuf);
#else
	return 0;
#endif
}

void SetHeadNvPara(int nodetype, int nodeid, int paraid, u32 * pBuf)
{
#if (CUR_MACHINE == MACH_EMB)
	SetEmbCoilParasProc(nodeid, pBuf);
#elif (CUR_MACHINE == MACH_WIRE)
	SetWireHeadAPara(nodeid, paraid, pBuf);
#endif
}

int CreateHeadNvParas(OperPacket * pPkt, u8 nodetype, u8 nodeId, u8 paraid, u8* pData)
{
	if (pPkt == NULL || pData == NULL)
	{
		return -1;
	}

	int rslt;

	memset(pPkt, 0, LEN_NORMAL_PACKET);

	pPkt->boardPara.cmdCode = DCMD_SEND_HEAD_NVPARAS;

	pPkt->boardPara.nodeId = nodeId;			// 上位机不需要知道具体节点ID,只负责存储在相应变量即可
	pPkt->boardPara.nodeType = nodetype;
	pPkt->boardPara.paraid = paraid;

	memcpy(&pPkt->boardPara.exData, pData, 128);

	rslt = PacketAVLDP(&(pPkt->packet), (u8*)(&(pPkt->boardPara.exData)), 128);
	if (rslt != 0)
	{
		printf("error at call PacketAVLDP in CreateHeadNvParas\r\n");
	}

	return rslt;
}

int CreateMcInfo(OperPacket * pPkt, int toggle)
{
	int rslt;
	MCInfo info;
	u16 ver;

	if (pPkt == NULL)
	{
		return -1;
	}

	memset(pPkt, 0, LEN_NORMAL_PACKET);
	memset(&info, 0, sizeof(MCInfo));

	pPkt->sendMcInfo.cmdCode = DCMD_SEND_MC_INFO;
	pPkt->sendMcInfo.toggle = (u16)toggle;

	ver = GetFpgaHardVersion();		// 读取硬件版本信息
	sprintf(info.fpgaHardVerStr, "FPGA Hard: %x.%x", (ver&0xff00)>>8,(ver&0x00ff));

	ver = GetFpgaSoftVersion();		// 读取软件版本信息
	sprintf(info.fpgaSoftVerStr, "FPGA Soft: %x.%x", (ver&0xff00)>>8,(ver&0x00ff));

	GetVersionStr(info.softwareVerStr);		// 软件版本信息

	GetBuildStr(info.buildInfoStr);			// 编译时间信息

	GetBoardIdInfo(info.boardId);			// 板卡ID信息

	GetLastInstallment(info.installment);	// 加密字符串

	printf("create system info len=%d, as follow:\r\n", sizeof(MCInfo));

	printf("%s\r\n", info.fpgaHardVerStr);			// FPGA硬件版本
	printf("%s\r\n", info.fpgaSoftVerStr);       	// FPGA软件版本
	printf("%s\r\n", info.softwareVerStr);      	// 软件版本
	printf("%s\r\n", info.buildInfoStr);        	// 编译日期信息
	printf("%s\r\n", info.boardId);             	// 板卡ID
	printf("%s\r\n", info.installment);         	// 最后一次的分期密码字符串

	rslt = PacketAVLDP(&(pPkt->packet), (u8*)(&(info)), sizeof(MCInfo));
	if (rslt != 0)
	{
		printf("error at call PacketAVLDP in CreateMcInfo\r\n");
	}

	return rslt;
}

// 运行状态
int CreateMcStatus(OperPacket * pPkt, int toggle)
{
	int rslt;
	if (pPkt == NULL)
	{
		return -1;
	}

	memset(pPkt, 0, LEN_NORMAL_PACKET);

	pPkt->sendMcStatus.cmdCode = DCMD_SEND_MC_STATUS;
	pPkt->sendMcStatus.toggle = (u16)toggle;

//	printf("create mc status len=%d\r\n", sizeof(MCStatus));

	rslt = PacketAVLDP(&(pPkt->packet), (u8*)(&(g_workCtrl.cursta)), sizeof(MCStatus));
	if (rslt != 0)
	{
		printf("error at call PacketAVLDP in CreateMcStatus\r\n");
	}

	return rslt;
}

// 运行文件位图
int CreateFileList(OperPacket * pPkt, int toggle)
{
	int rslt;
	if (pPkt == NULL)
	{
		return -1;
	}

	memset(pPkt, 0, LEN_NORMAL_PACKET);

	pPkt->setFilesList.cmdCode= DCMD_SEND_FILE_LIST;
	pPkt->setFilesList.fileIdxMap = (u16)toggle;

//	printf("create mc status len=%d\r\n", sizeof(MCStatus));

	rslt = PacketAVLDP(&(pPkt->packet), (u8*)(&(g_workCtrl.cursta)), sizeof(MCStatus));
	if (rslt != 0)
	{
		printf("error at call PacketAVLDP in CreateMcStatus\r\n");
	}

	return rslt;
}

__WEAK void SensorsStatus(int mode, u8 * buf)
{
}

// 传感信号
int CreateSensorsStatus(OperPacket * pPkt)
{
	int rslt;
	u8 insta[MAX_EXDP_LEN];
	if (pPkt == NULL)
	{
		return -1;
	}

	memset(pPkt, 0, LEN_NORMAL_PACKET);
	memset(&insta, 0, MAX_EXDP_LEN);

	pPkt->sendSensors.cmdCode = DCMD_SEND_SENSORS;

	SensorsStatus(0, &insta[0]);

	rslt = PacketAVLDP(&(pPkt->packet), (u8*)(&(insta)), MAX_EXDP_LEN);
	if (rslt != 0)
	{
		printf("error at call PacketAVLDP in CreateMcStatus\r\n");
	}

	return rslt;
}


// 传感信号位图
int CreateSensorsBmp(OperPacket * pPkt)
{
	int rslt;
	u8  insta[MAX_EXDP_LEN];

	if (pPkt == NULL)
	{
		return -1;
	}

	memset(pPkt, 0, LEN_NORMAL_PACKET);

	pPkt->sendSensors.cmdCode = DCMD_SEND_SENSORS_BMP;

	SensorsStatus(1, &insta[0]);

	rslt = PacketAVLDP(&(pPkt->packet), (u8*)(&(insta)),MAX_EXDP_LEN);
	if (rslt != 0)
	{
		printf("error at call PacketAVLDP in CreateSensorsBmp\r\n");
	}

	return rslt;
}

//-------------------------------------------------------------------------------

// 遍历任务
void TraverseTask(u8 protocol, u8 nodeId, u8 nodeType, int traNum)
{
#if (CUR_MACHINE == MACH_EMB)	// 绣花机
	EmbTraverseTask(nodeId, nodeType, traNum);
#elif (CUR_MACHINE == MACH_WIRE)
	WireTraverseTask(nodeId, traNum);
#else
#endif
}

void ResetCHB(u32 hdsel)
{
	g_workCtrl.cursta.errorCode = ERR_NONE;
	g_workCtrl.almflashGreen = ALM_LIT_FLASH;
	g_workCtrl.almflashRed = ALM_LIT_OFF;
	g_workCtrl.almflashYello = ALM_LIT_OFF;
	g_workCtrl.almflashBee = ALM_LIT_OFF;

	g_workCtrl.cursta.btrdLength = g_workCtrl.chBobbinLength;
	g_workCtrl.savedpara.btrdLength = g_workCtrl.cursta.btrdLength;
	g_workCtrl.cursta.btrdPics = g_workCtrl.chBobbinPics;
	g_workCtrl.savedpara.btrdPics = g_workCtrl.cursta.btrdPics;

	SaveWorkNvPara();

	printf("get cmd MC_CLEAN_BOBBIN\r\n");

	ReportError(0);
}

// 设置工作状态
void SetMcStatus(u32 sta, u32 para)
{
	switch(sta)
	{
	case MC_STA_CLENA_ERR:		// 清除错误
		CleanError();
		break;
	case MC_STA_EN_WORK:		// 允许工作(状态)
		printf("set en work sta\r\n");
		g_workCtrl.cursta.workStatus |= WORK_STA_ENSTATE;
		break;
	case MC_STA_DIS_WORK:		// 禁止工作(状态)
		printf("set dis work sta\r\n");
		g_workCtrl.cursta.workStatus &= ~(WORK_STA_ENSTATE);
		break;
	case MC_STA_EN_TIME:		// 允许工作(时间)
		g_workCtrl.cursta.workStatus |= WORK_STA_ENTIME;
		break;
	case MC_STA_DIS_TIME:		// 禁止工作(时间)
		g_workCtrl.cursta.workStatus &= ~(WORK_STA_ENTIME);
		break;
	case MC_CLEAN_COUNT:		// 产量计数清零
	{
		if (para == 0)
		{
			g_workCtrl.cursta.outCounter = 0;
			g_workCtrl.cursta.embNeedleNum = 0;		// 20211027,增加清空产量的同时清空刺绣针数
		}
		else
		{
			int decinc = (s16)para;
			decinc += g_workCtrl.cursta.outCounter;
			if (decinc < 0)
			{
				decinc = 0;
			}
			g_workCtrl.cursta.outCounter = decinc;
		}
		g_workCtrl.savedpara.outCounter = g_workCtrl.cursta.outCounter;
		g_workCtrl.savedpara.embNeedleNum = g_workCtrl.cursta.embNeedleNum;

		SaveWorkNvPara();
		ReportError(0);
		break;
	}
	case MC_STA_MANUAL:			// 手动工作状态
		g_workCtrl.cursta.workStatus &= ~(WORK_STA_WKAUTO);
		break;
	case MC_STA_AUTO:			// 自动工作状态
		g_workCtrl.cursta.workStatus |= WORK_STA_WKAUTO;
		break;
	case MC_FILE_SWITCH:		// 文件切换
		g_workCtrl.cursta.fileIdx = para;
		break;
	case MC_INVALID_FILE:		// 文件失效命令
		InvalidDatFile(para);
		g_workCtrl.cursta.workStatus &= ~(WORK_STA_EN_SCAN);	// 禁止扫码
		printf("get InvalidDatFile cmd, Reset work sta en scan1\r\n");
		break;
	case MC_CLEAN_PARA_REF:		// 清除刷新参数标志
		g_workCtrl.cursta.workStatus &= ~(WORK_STA_NEW_PARA);
		break;
	case MC_SET_TO_NORMAL:		// 设置为正常工作状态
		g_workCtrl.cursta.workStatus &= ~(WORK_STA_SIMULATE);
		break;
	case MC_SET_TO_SIMULATE:	// 设置为模拟工作状态
		g_workCtrl.cursta.workStatus |= WORK_STA_SIMULATE;
		break;
	case MC_CLEAN_FIDX:
		SetDatIdxToStart();
		/*
		g_workCtrl.cursta.dataIdx = 0;	// 文件索引复位
		g_workCtrl.savedpara.dataIdx = g_workCtrl.cursta.dataIdx;
		SaveWorkNvPara();
		GetWorkPosFromIndex();*/
		break;
	case MC_CLEAN_BOBBIN:		// 底线计数复位
		ResetCHB(para);
		break;
	case MC_SET_ENTER_SCAN_SENSOR:		// 设置为 进入 扫描传感器状态
		g_workCtrl.cursta.workStatus |= WORK_STA_SENSOR;
		printf("get MC_SET_ENTER_SCAN_SENSOR cmd\r\n");
		break;
	case MC_SET_EXIT_SCAN_SENSOR:	// 设置为 退出 扫描传感器状态
		g_workCtrl.cursta.workStatus &= ~(WORK_STA_SENSOR);
		CleanButtonTask();
		printf("get MC_SET_EXIT_SCAN_SENSOR cmd\r\n");
		break;
	case MC_SET_ENTER_TEST_OUTPUT:		// 设置为 进入 测试输出状态
		g_workCtrl.cursta.workStatus |= WORK_STA_OUTPUT;
		printf("get MC_SET_ENTER_TEST_OUTPUT cmd\r\n");
		break;
	case MC_SET_EXIT_TEST_OUTPUT:	// 设置为 退出 测试输出状态
		g_workCtrl.cursta.workStatus &= ~(WORK_STA_OUTPUT);
		CleanButtonTask();
		printf("get MC_SET_EXIT_TEST_OUTPUT cmd\r\n");
		break;

	case MC_STA_EXIT_TRA:			// 退出遍历状态
	{
		g_workCtrl.cursta.workStatus |= WORK_STA_TRAVERSE;
		break;
	}

	case MC_STA_EXIT_THREADBK:	// 退出断线检测状态
	{
		g_workCtrl.cursta.workStatus &= ~(WORK_STA_DETBK);
		break;
	}

	case MC_INVALID_FILEBLOCK:	// 文件数据块失效命令(网络服务器实时传输花样文件)
	{
		InvalidDatBlock();
		break;
	}
	default:
		break;
	}
}

// 手动控制
int ControlByHand(OperPacket * pPkt)
{
	int err;
	printf("receive ctrl by hand, actcode=0x%x, para1=0x%x, para2=0x%x, para3=0x%x\r\n",
			pPkt->actByhand.actCode, pPkt->actByhand.para1, pPkt->actByhand.para2, pPkt->actByhand.para3);

	err = ERR_NONE;

	if (err != ERR_NONE)
	{
		ReportError(err);
		return err;
	}

	switch (pPkt->actByhand.actCode)
	{
		case MOTO_TO_ZERO:		// 电机归零
			MotoToZero(pPkt->actByhand.para1);
			break;
		case MOVE_BY_HAND:		// 电机手动移动
//			printf("para1=%d, para2=%d, para3=%d\r\n", pPkt->actByhand.para1, pPkt->actByhand.para2, pPkt->actByhand.para3);
			MoveMotoByHand(pPkt->actByhand.para1, pPkt->actByhand.para2, pPkt->actByhand.para3);
			break;
		case OUTPUT_CTRL:		// 输出控制
			OutputByHand(pPkt->actByhand.para1, pPkt->actByhand.para2, pPkt->actByhand.para3);
			break;
		case MOTO_EN_CTRL:		// 伺服打开关闭
			MotosServoCtrl(pPkt->actByhand.para1, pPkt->actByhand.para2);
			break;
		case MANUAL_ACTION:		// 手动控制功能
			ManualActionCtrl(pPkt->actByhand.para1, pPkt->actByhand.para2, pPkt->actByhand.para3);
			break;
		case TEST_THREADBK:		// 测试断线检测
			TestThreadBreak(pPkt->actByhand.para1, pPkt->actByhand.para2, pPkt->actByhand.para3);
			break;
		case SHAKE_FRAME_TEST:	// 抖框测试
			ShakeFrameTest(pPkt->actByhand.para1, pPkt->actByhand.para2, pPkt->actByhand.para3);
			break;

		default:
			break;
	}

	return 0;
}

__WEAK void MotoToZero(u16 obj)
{
}

__WEAK void MoveMotoByHand(u16 obj, u16 dir, u16 spd)
{
}

__WEAK void OutputByHand(u16 obj, u16 act, u16 para)
{
}

__WEAK void MotosServoCtrl(u16 obj, u16 onoff)
{
}

__WEAK void ManualActionCtrl(u16 obj, u16 para2, u16 para3)
{
}

__WEAK void TestThreadBreak(int type, int needle, int head)
{
}

void ShakeFrameTest(u16 ofstx, u16 ofsty, u16 runspd)
{
#if (CUR_MACHINE == MACH_WIRE)
	WireShakeFrameTest(ofstx, ofsty, runspd);
#endif
}

int ControlWork(OperPacket * pPkt)
{
	printf("work cmd, code=0x%x\r\n", pPkt->mcWork.workCode);
	switch(pPkt->mcWork.workCode)
	{
		case WORK_START:		// 启动工作
		{
			break;
		}
		case WORK_PAUSE:		// 暂停工作
		{
			break;
		}
		case WORK_FINISH:		// 流程复位
		{
			AllToReset();
			break;
		}
		case WORK_FIND_ZERO:	// 自动找零
		{
			AllToZero();
			break;
		}
		case WORK_GOTO_START:	// 回起点
		{
			GotoStartPos();
			break;
		}
		case WORK_GOTO_ANCHOR:	// 回定位点
		{
			GotoAnchorPos();
			break;
		}
		case WORK_GOTO_OFFSET:	// 回偏移点
		{
			GotoOffsetPos();
			break;
		}
		case WORK_SET_OFFSET:	// 定偏移点
		{
			SetOffsetPos();
			break;
		}
		case WORK_CHECK_FRAME:	// 边框检查
		{
			CheckFrame();
			break;
		}

		case WORK_SIMULATION_FRAME:	// 空走边框
		{
			SimulationFrame();
			break;
		}

		case WORK_FAST_JUMP:	// 快速进退
		{
			FastJump(pPkt->mcWork.para1);
			break;
		}

		case WORK_GOTO_WKPOS:	// 回工作点
		{
			GotoWorkPos();
			break;
		}

		case WORK_GOTO_FINISH:	// 回结束点
		{
			GotoFinishPos();
			break;
		}
		case WORK_GOTO_ZERO:	// 回零点位
		{
			GotoFrameZeroPos();
			break;
		}

		case WORK_RPM_CHG:		// 速度改变
		{
			ChangeRpm((int)(pPkt->mcWork.para1));
			break;
		}

		case WORK_FILE_IDX_CHG:		// 文件序号改变
		{
			g_workCtrl.cursta.fileIdx = (pPkt->mcWork.para1);
			break;
		}

		case WORK_GOTO_FEED:		// 回上料点
		{
			GotoFeedPos();
			break;
		}
		case WORK_SET_FEED:			// 定上料点
		{
			SetFeedPos();
			break;
		}
		case WORK_ACT_OIL:			// 手动加油
		{
			OilingInWorking(pPkt->mcWork.para1);
			break;
		}

		default:
			break;
	}

	return 0;
}

int ControlWorkWhenWorking(OperPacket * pPkt)
{
	if (pPkt == NULL)
	{
		return -1;
	}
	printf("work cmd when work, code=0x%x\r\n", pPkt->mcWork.workCode);
	switch(pPkt->mcWork.workCode)
	{
		case WORK_PAUSE:		// 暂停工作
		{
			g_workCtrl.stopFlag = 1;
			break;
		}
		case WORK_RPM_CHG:    // 速度改变
		{
			ChangeRpm((int)(pPkt->mcWork.para1));
			break;
		}
		case WORK_ACT_OIL:		// 工作中手动加油
		{
			OilingInWorking(pPkt->mcWork.para1);
			break;
		}
		default:
			break;
	}

	return 0;
}

__WEAK void ChangeRpm(int rpmchg)
{
}

// 流程复位
__WEAK void AllToReset(void)
{
}

__WEAK void AllToZero(void)
{
}

__WEAK int GotoStartPos(void)
{
	return 0;
}

__WEAK int GotoAnchorPos(void)
{
	return 0;
}

__WEAK int GotoOffsetPos(void)
{
	return 0;
}

__WEAK void SetOffsetPos(void)
{
}

__WEAK int GotoWorkPos(void)
{
	return 0;
}

__WEAK int GotoFinishPos(void)
{
	return 0;
}

__WEAK int GotoFeedPos(void)
{
	return 0;
}

__WEAK void SetFeedPos(void)
{
}

__WEAK int GotoFrameZeroPos(void)
{
	return 0;
}

__WEAK int CheckFrame(void)
{
	return 0;
}

// 空走边框
void SimulationFrame(void)
{
#if (CUR_MACHINE == MACH_EMB)
	EmbSimulationFrame();
#endif
}

__WEAK int FastJump(u32 idx)
{
	return 0;
}

__WEAK void OilingInWorking(u32 para1)
{
}

__WEAK int MoveFrameToPos(s32 posx, s32 posy)
{
	return 0;
}

// 定量移框
__WEAK int FixMoveFrame(s32 xmvmnt, s32 yxmvmnt)
{
	return 0;
}

void MoveFrameTo(OperPacket * pPkt)
{
	s32 posx, posy;

	posx = pPkt->moveFrameTo.posx;
	posy = pPkt->moveFrameTo.posy;

	printf("move to cmd, posx=%d, posy=%d\r\n", posx, posy);

	MoveFrameToPos(posx, posy);

}

void MoveFrameAsOfst(OperPacket * pPkt)
{
	s32 ofstx, ofsty;

	ofstx = pPkt->moveFrameTo.posx;
	ofsty = pPkt->moveFrameTo.posy;

	printf("move as ofst cmd, ofstx=%d, ofsty=%d\r\n", ofstx, ofsty);

	FixMoveFrame(ofstx, ofsty);
}

//-------------------------------------------------------------------------------

int ReportError(int errCode)
{
	if (errCode != g_workCtrl.cursta.errorCode)
	{
		printf("Error: code=0x%x\r\n", errCode);
		//printf("cursta work status 0x%x\r\n",g_workCtrl.cursta.workStatus);
	}

	g_workCtrl.cursta.errorCode = errCode;

	SendStatus(1);
	return 0;
}

void CleanError(void)
{
	ReportError(ERR_NONE);
}

__WEAK void SetLightStaByCode(int errCode)
{
	if (errCode == 0 || (errCode >= 0x100 && errCode < 0x200))	// 状态
	{
		if (((g_workCtrl.cursta.workStatus & WORK_STA_WORKING) == WORK_STA_WORKING) ||
			((g_workCtrl.cursta.workStatus & WORK_STA_SIMULATE) == WORK_STA_SIMULATE) ||
			((g_workCtrl.cursta.workStatus & WORK_STA_BUSY) == WORK_STA_BUSY) ||
			0 )
		{
			g_workCtrl.almflashRed = ALM_LIT_OFF;		// 关红灯
			g_workCtrl.almflashGreen = ALM_LIT_FLASH;	// 开绿灯
			g_workCtrl.almflashYello = ALM_LIT_OFF;		// 关黄灯
			g_workCtrl.almflashBee = ALM_LIT_OFF;		// 闪蜂鸣器
		}
		else
		{
			g_workCtrl.almflashRed = ALM_LIT_OFF;		// 关红灯
			g_workCtrl.almflashGreen = ALM_LIT_OFF;		// 关绿灯
			g_workCtrl.almflashYello = ALM_LIT_ON;		// 开黄灯
			g_workCtrl.almflashBee = ALM_LIT_OFF;		// 关蜂鸣器
		}
	}
	else	// 错误
	{
		g_workCtrl.almflashRed = ALM_LIT_FLASH;		// 开红灯
		g_workCtrl.almflashGreen = ALM_LIT_OFF;		// 关绿灯
		g_workCtrl.almflashYello = ALM_LIT_OFF;		// 关黄灯
		g_workCtrl.almflashBee = ALM_LIT_FLASH;		// 闪蜂鸣器
	}
}

// 状态改变判断
int IsStatusChanged(void)
{
	int rslt;

	RefreshStatus();

	g_workCtrl.cursta.workableTimer = GetWorkableTime();		// 更新计数值

	// 比较，不同则发送
	rslt = memcmp(&(g_workCtrl.oldsta), &(g_workCtrl.cursta), sizeof(MCStatus));
	if (rslt != 0)
	{
		memcpy(&(g_workCtrl.oldsta), &(g_workCtrl.cursta), sizeof(MCStatus));
	}
	return rslt;
}

void SendStatus(int force)
{
	SendMcStatus(force);
}

__WEAK void CheckSensorAndPos(void)
{
}

//-------------------------------------------------------------------------------

// 查询当前数据执行进度，并从上位机请求数据
void CheckAndRequestData(void)
{
	static int olddatblockIdx = -1;	// 记录上一次请求的数据块ID
	static u32 requesttimer = 0;	// 请求时间记录
	if (IsDatFileAvailable() == TRUE &&	// 20231017
			g_datFile.storage == STORAGE_NETWORK &&		// 20240204
			g_workCtrl.requestFlag == 0 &&		// 20240606
			1)
	{
		u32 timer = GetMsSoftTimer();

		int datblockIdx = GetBlockIdxNeedtoLoad(GetDatIndex());
		if (datblockIdx >= 0)
		{
			if (olddatblockIdx != datblockIdx ||
					((timer - requesttimer) > REQUEST_GAP) ||
					0)
			{
				olddatblockIdx = datblockIdx;
				requesttimer = timer;
				RequestADataBlock(datblockIdx);
			}
		}
	}
}

void SetFileOkFlag(int flag)
{
	if (flag == 0)
	{
		printf("clean file ok flag\r\n");
		g_workCtrl.cursta.workStatus &= ~(WORK_STA_FILEOK);	// 文件接收标志
	}
	else
	{
		printf("set file ok flag\r\n");
		g_workCtrl.cursta.workStatus |= WORK_STA_FILEOK;		// 文件接收标志
	}

	SendStatus(0);
}

void SaveFileIdxFromDatafile(void)
{
	g_workCtrl.cursta.fileIdx = g_datFile.fileIdx;
	g_workCtrl.savedpara.fileIdxMap = g_datFile.fileIdxMap;
	g_workCtrl.savedpara.fileIdx = g_workCtrl.cursta.fileIdx;
	SaveWorkNvPara();
}

int GetDatIndex(void)
{
	return g_workCtrl.cursta.dataIdx;
}

int DatIndexInc(void)
{
	int rslt;
	rslt = g_workCtrl.cursta.dataIdx + 1;

	if (IsDatIndexAvailable(rslt) == TRUE)
	{
		g_workCtrl.cursta.dataIdx = rslt;
		g_workCtrl.savedpara.dataIdx = g_workCtrl.cursta.dataIdx;
		SaveWorkNvPara();
	}
	else
	{
		rslt = -1;
	}

	return rslt;
}

int DatIndexDec(void)
{
	if (g_workCtrl.cursta.dataIdx != 0)
	{
		g_workCtrl.cursta.dataIdx--;

		g_workCtrl.savedpara.dataIdx = g_workCtrl.cursta.dataIdx;
		SaveWorkNvPara();
		return g_workCtrl.cursta.dataIdx;
	}
	else
	{
		return -1;
	}
}

__WEAK int GetWorkPosFromIndex(void)
{
	return 0;
}

int SetExecProgress(OperPacket * pPkt)
{
	int rslt;
	FileExecPara execPara;

	if (pPkt == NULL)
	{
		return -1;
	}

	if (pPkt->setExecProgress.exLen != sizeof(execPara))
	{
		printf("receive len not equ, receivelen=%d, FileExecPara = %d", pPkt->setExecProgress.exLen, sizeof(execPara));
		rslt = -2;
	}
	else
	{
		memcpy((u8*)(&execPara), pPkt->setExecProgress.exData, sizeof(execPara));
		rslt = 0;
	}

	if (rslt == 0)
	{
#if (CUR_MACHINE == MACH_EMB)
		rslt = EmbSetProgress(&execPara);
#elif (CUR_MACHINE == MACH_PES)
		rslt = PESSetProgress(&execPara);
#endif
		if (rslt == 0)	// 20231017
		{
			g_workCtrl.savedpara.dataIdx = g_workCtrl.cursta.dataIdx;
			SaveWorkNvPara();
		}
	}

	return rslt;
}

// 数据从头开始
void SetDatIdxToStart(void)
{
	g_workCtrl.cursta.dataIdx = 0;			// 当前花样的针迹数据索引

	g_workCtrl.cursta.colorIdx = 0;			// 20220708 数据从头开始,色序也应该从头开始

	g_workCtrl.savedpara.dataIdx = g_workCtrl.cursta.dataIdx;
	SaveWorkNvPara();

	// 机头补绣
	g_workCtrl.embMendEndIdx = -1;
	g_workCtrl.embMendTrdFlag = 0;
	g_workCtrl.mendEndPatternIdx = 0;

	GetWorkPosFromIndex();

#if (CUR_MACHINE == MACH_EMB)
	EmbSetDatIdxToStart();
#endif

}

//-------------------------------------------------------------------------------

void SaveToNvArea(s32 * posilist)
{
	if (posilist != NULL)
	{
		memcpy((s32 *)(&(g_workCtrl.savedpara.motospos[0])), posilist, sizeof(s32)*AXIS_NUM);
		SaveWorkNvPara();
	}
}

void ReadAndFreshMotosPos(void)
{
	s32 pos[AXIS_NUM];

	if (GetMotosCounter(pos) == 0)
	{
		RefreshMotosPos(pos);
		SaveToNvArea(pos);		// 保存到掉电保护区域
	}
}

void ReadMotosPos(void)
{// 只刷新,不保存
	s32 pos[AXIS_NUM];

	if (GetMotosCounter(pos) == 0)
	{
		RefreshMotosPos(pos);
		//SaveToNvArea(pos);		// 保存到掉电保护区域
	}
}

void NormalRefPosition(u32 para, s32 * posilist)
{
	SaveToNvArea(posilist);
}

//-------------------------------------------------------------------------------