335 lines
8.2 KiB
C
335 lines
8.2 KiB
C
#if 0
|
||
#include <stdio.h>
|
||
#include <string.h>
|
||
#include "uart_dev.h"
|
||
#include "com.h"
|
||
#include "driver.h"
|
||
|
||
//static int dataCount;
|
||
//static unsigned char TestDataBuf[1000];
|
||
|
||
extern G_USART usart1;
|
||
extern volatile DT_BOOLEAN g_UpSenDataIP;
|
||
|
||
tagComDataRecv g_ComDataRecv; //命令缓冲区
|
||
static unsigned char gs_SendBuffer[SENDBUFFER_LEN]; //串口发送缓冲区
|
||
|
||
/******************************************************************************
|
||
* Function: Com_SendData
|
||
* Description:发送数据
|
||
* Calls: none
|
||
* Called By:
|
||
* Input: pDataBuffer-数据缓冲区 dataLen- 数据长度addr - 地址cmdtype -命令类型
|
||
* Ouput:
|
||
* Return:
|
||
* others:
|
||
* History:
|
||
* 1.luoyang created 2018-02-04
|
||
*
|
||
*******************************************************************************/
|
||
void Com_SendData(unsigned char *pDataBuffer,unsigned int dataLen,unsigned char addr,unsigned char cmdtype)
|
||
{
|
||
unsigned short FrameLen = 0;
|
||
unsigned char checkSum;
|
||
int i;
|
||
|
||
//无数据或错误操作
|
||
if(NULL == pDataBuffer )
|
||
{
|
||
dataLen = 0;
|
||
}
|
||
|
||
//数据超过缓冲区长度
|
||
if(dataLen > SENDDATA_LEN_MAX)
|
||
{
|
||
dataLen = SENDDATA_LEN_MAX;
|
||
}
|
||
FrameLen = FRAME_HEAD_LEN + dataLen;
|
||
//组帧
|
||
memset(gs_SendBuffer, 0, sizeof(gs_SendBuffer));
|
||
gs_SendBuffer[FRAME_HEAD_L] = 0x4A; //帧头
|
||
gs_SendBuffer[FRAME_HEAD_H] = 0x59;
|
||
gs_SendBuffer[FRAME_LENGTH_L] = FrameLen & 0xFF; //帧长
|
||
gs_SendBuffer[FRAME_LENGTH_H] = (FrameLen >> 8) & 0xFF;
|
||
gs_SendBuffer[FRAME_DEVICE_TYPE] = 0x02; //装置类型
|
||
gs_SendBuffer[FRAME_DEVICE_ADDR] = addr; //装置地址
|
||
gs_SendBuffer[FRAME_TYPE] = 0x02; //帧类型，传感器到设备
|
||
gs_SendBuffer[FRAME_CMD_TYPE] = cmdtype; //命令类型
|
||
//拷贝数据
|
||
if(dataLen > 0)
|
||
{
|
||
memcpy(&gs_SendBuffer[FRAME_DATE_START],pDataBuffer,dataLen);
|
||
}
|
||
|
||
//计算校验码
|
||
for(i = 0,checkSum = 0; i < FrameLen-1; i++)
|
||
{
|
||
checkSum += gs_SendBuffer[i];
|
||
}
|
||
|
||
gs_SendBuffer[FrameLen - 1] = checkSum; //校验码
|
||
//发送
|
||
drv_Send(gs_SendBuffer, FrameLen);
|
||
|
||
/*if ((dataCount-10)>=999)
|
||
dataCount=0;
|
||
memcpy(TestDataBuf+dataCount, gs_SendBuffer, FrameLen);
|
||
dataCount = dataCount+FrameLen;*/
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Function: Handle_upSend_Data
|
||
* Description:解析协议，上送数据
|
||
* Calls: none
|
||
* Called By:
|
||
* Input: pDataBuffer-数据缓冲区 dataLen- 数据长度addr - 地址cmdtype -命令类型
|
||
* Ouput:
|
||
* Return:
|
||
* others:
|
||
* History:
|
||
* 1.luoyang created 2018-02-04
|
||
*
|
||
*******************************************************************************/
|
||
void Handle_upSend_Data(unsigned char *pFrame)
|
||
{
|
||
unsigned char addr,temp,cmdType;
|
||
unsigned char Data[30], workMode=0;
|
||
//float xValue=0,yValue=0,zValue=0;
|
||
unsigned short int upFreq=0;
|
||
|
||
//命令类型
|
||
cmdType = pFrame [FRAME_CMD_TYPE];
|
||
|
||
switch (cmdType)
|
||
{
|
||
//设定地址
|
||
case COMMAND_TYPE_SET_ADDR:
|
||
addr = pFrame[FRAME_DATE_START];
|
||
SetAddress(addr);
|
||
Data[0] = 0xFF; //成功
|
||
Com_SendData(Data,1,addr,COMMAND_TYPE_SET_ADDR);
|
||
break;
|
||
//查询地址
|
||
case COMMAND_TYPE_SCAN_ADDR:
|
||
addr = ReadAddress();
|
||
Data[0] = addr; //实际地址
|
||
Com_SendData(Data,1,0xFF,COMMAND_TYPE_SCAN_ADDR);
|
||
break;
|
||
//查询数据传输方式
|
||
case COMMAND_TYPE_GET_WORKMODE:
|
||
addr = ReadAddress();
|
||
ReadWorkMode(&workMode, &upFreq);
|
||
Data[0] = workMode;
|
||
memcpy(Data + 1,(void*)&upFreq,2);
|
||
Com_SendData(Data,3,addr,COMMAND_TYPE_GET_WORKMODE);
|
||
break;
|
||
//设定数据传输方式
|
||
case COMMAND_TYPE_SET_WORKMODE:
|
||
addr = ReadAddress();
|
||
workMode = pFrame[FRAME_DATE_START];
|
||
upFreq = 256*(pFrame[(FRAME_DATE_START+2)])+pFrame[(FRAME_DATE_START+1)];
|
||
SetWorkMode(workMode, upFreq);
|
||
Data[0] = 0xFF; //成功
|
||
Com_SendData(Data,1,addr,COMMAND_TYPE_SET_WORKMODE);
|
||
break;
|
||
//读取数据
|
||
/*case COMMAND_TYPE_GETDATA: //数据
|
||
addr = ReadAddress();
|
||
//获取测量值，归一化处理
|
||
if(SD_SUCCESS != GetAngleMeasureValue(&xValue,&yValue,&zValue))
|
||
{
|
||
return;
|
||
}
|
||
//X值
|
||
memcpy(Data,(void*)&xValue,4);
|
||
//Y值
|
||
memcpy(Data + 4,(void*)&yValue,4);
|
||
//Z值
|
||
memcpy(Data + 8,(void*)&zValue,4);
|
||
//发送
|
||
Com_SendData(Data,12,addr,COMMAND_TYPE_GETDATA);
|
||
break;*/
|
||
//角度校正
|
||
case COMMAND_TYPE_SCALE: //矫正
|
||
addr = ReadAddress();
|
||
AngleScale(); //校正
|
||
Data[0] = 0xFF; //成功
|
||
Com_SendData(Data,1,addr,COMMAND_TYPE_SCALE);
|
||
break;
|
||
//清除角度校正
|
||
case COMMAND_TYPE_SCALE_RESET:
|
||
addr = ReadAddress();
|
||
AngleScale_Reset(); //校正复位
|
||
Data[0] = 0xFF; //成功
|
||
Com_SendData(Data,1,addr,COMMAND_TYPE_SCALE_RESET);
|
||
break;
|
||
//召原始数据
|
||
case COMMAND_TYPE_CALL_ORIGINALVALUE:
|
||
temp = pFrame[FRAME_DATE_START];; //1：x,2:y
|
||
StartWave(temp);
|
||
break;
|
||
//读取装置信息
|
||
case COMMAND_TYPE_CALLINFO:
|
||
addr = ReadAddress();
|
||
temp = GetSensorInfo(Data);
|
||
Com_SendData(Data,temp,addr,COMMAND_TYPE_CALLINFO);
|
||
break;
|
||
default:
|
||
break;
|
||
}
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Function: UpSendDataActive
|
||
* Description:主动上送数据
|
||
* Calls: none
|
||
* Called By:
|
||
* Input:
|
||
* Ouput:
|
||
* Return:
|
||
* others:
|
||
* History:
|
||
* 1.luoyang created 2018-02-04
|
||
*
|
||
*******************************************************************************/
|
||
void UpSendDataActive(void)
|
||
{
|
||
unsigned char addr;
|
||
unsigned char Data[30] ;
|
||
float xValue,yValue,zValue;
|
||
|
||
if(SD_TRUE != g_UpSenDataIP)
|
||
return;
|
||
|
||
addr = ReadAddress();
|
||
//获取测量值，归一化处理
|
||
GetAngleMeasureValue(&xValue,&yValue,&zValue);
|
||
//X值
|
||
memcpy(Data,(void*)&xValue,4);
|
||
//Y值
|
||
memcpy(Data + 4,(void*)&yValue,4);
|
||
//Z值
|
||
memcpy(Data + 8,(void*)&zValue,4);
|
||
//发送
|
||
Com_SendData(Data,12,addr,COMMAND_TYPE_GETDATA);
|
||
g_UpSenDataIP = SD_FALSE;
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Function: UpSendDataCall
|
||
* Description:应答上送数据
|
||
* Calls: none
|
||
* Called By:
|
||
* Input:
|
||
* Ouput:
|
||
* Return:
|
||
* others:
|
||
* History:
|
||
* 1.luoyang created 2018-02-04
|
||
*
|
||
*******************************************************************************/
|
||
void UpSendDataCall(void)
|
||
{
|
||
unsigned char addr;
|
||
unsigned char Data[30] ;
|
||
float xValue=0,yValue=0,zValue=0;
|
||
|
||
addr = ReadAddress();
|
||
//获取测量值，归一化处理
|
||
GetAngleMeasureValue(&xValue,&yValue,&zValue);
|
||
//X值
|
||
memcpy(Data,(void*)&xValue,4);
|
||
//Y值
|
||
memcpy(Data + 4,(void*)&yValue,4);
|
||
//Z值
|
||
memcpy(Data + 8,(void*)&zValue,4);
|
||
//发送
|
||
Com_SendData(Data,12,addr,COMMAND_TYPE_GETDATA);
|
||
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Function: CheckComData
|
||
* Description:从接受缓冲区中解析命令
|
||
* Calls: none
|
||
* Called By:
|
||
* Input:
|
||
* Ouput:
|
||
* Return:
|
||
* others:
|
||
* History:
|
||
* 1.L.Y. created 20180210
|
||
*
|
||
*******************************************************************************/
|
||
void CheckComData(void)
|
||
{
|
||
unsigned char counter = 0;
|
||
unsigned char *pBuffer;
|
||
unsigned char readIP;
|
||
|
||
while(g_ComDataRecv.ReadIP != g_ComDataRecv.WriteIP)
|
||
{
|
||
//置锁标识
|
||
g_ComDataRecv.Lock = SD_TRUE;
|
||
readIP = g_ComDataRecv.ReadIP;
|
||
g_ComDataRecv.ReadIP = (g_ComDataRecv.ReadIP + 1) % ASDU_MUN;
|
||
//置位锁标识
|
||
g_ComDataRecv.Lock = SD_FALSE;
|
||
|
||
pBuffer = (DT_UINT8 *)g_ComDataRecv.AsduFrame[readIP];
|
||
//处理数据帧
|
||
Handle_upSend_Data(pBuffer);
|
||
counter ++;
|
||
//最多处理三帧
|
||
if(counter >= 3)
|
||
{
|
||
break;
|
||
}
|
||
}
|
||
}
|
||
/******************************************************************************
|
||
* Function: Com_RecvFram_Handle
|
||
* Description:串口收满一帧数据回调函数
|
||
* Calls: none
|
||
* Called By:
|
||
* Input:
|
||
* Ouput:
|
||
* Return:
|
||
* others:
|
||
* History:
|
||
* 1.L.Y. created 20180210
|
||
*
|
||
*******************************************************************************/
|
||
DT_VOID Com_RecvFram_Handle()
|
||
{
|
||
DT_UINT8 WriteIP;
|
||
|
||
WriteIP = g_ComDataRecv.WriteIP;
|
||
|
||
//长度超范围
|
||
if(usart1.FrameLen > ASDU_LEN_MAX)
|
||
{
|
||
return;
|
||
}
|
||
if (usart1.RecvBuf[FRAME_CMD_TYPE]==COMMAND_TYPE_GETDATA)
|
||
{
|
||
myDelay_ms(2);
|
||
UpSendDataCall();
|
||
return;
|
||
}
|
||
//满
|
||
if((WriteIP + 1) % ASDU_MUN == g_ComDataRecv.ReadIP)
|
||
{
|
||
if(SD_TRUE == g_ComDataRecv.Lock)
|
||
{
|
||
return;
|
||
}
|
||
//修改写指针，扔掉旧数据
|
||
g_ComDataRecv.ReadIP = (g_ComDataRecv.ReadIP + (ASDU_MUN / 4)) % ASDU_MUN;
|
||
|
||
}
|
||
memcpy((DT_UINT8 *)g_ComDataRecv.AsduFrame[WriteIP],usart1.RecvBuf,usart1.FrameLen);
|
||
//改变写指针
|
||
g_ComDataRecv.WriteIP = (WriteIP + 1) % ASDU_MUN;
|
||
}
|
||
#endif
|