ttss_weight/source/tpc/tpc_modbus.c

/*****************************************************************************
update by cc @201501101001
针对多串口 和 单一串口 有区别 每个串口是独立的还是分开的有讲究 程序是复杂的还是软件应用简单是
个需要平衡的事情.d

uartcom/uartlib.c:  
公用的函数 	和硬件无关 
放置串行模式(串口等其他通讯总线类的输出)输出的函数,
一些覆盖模式输出的(lcd等固屏输出的)的也可使用  
					void Lc_print(void (*L0pf_send_uc)(char ww), char *dat,...)
-----------------------------------------------------------------------------------------
uartcom/uartcom0  
  和uart相关的通讯协议 com + n 
  为了适应不同的通讯协议需要不同的uart口来对应 和应用相关

typedef struct _ts_lcm_pro_; 应用协议包的定义?    LCM的协议------------
											L3_UARTcom0_exp_protocol 解析应用协议
-----------------------------------------------------------------------------------------
uartcom/uprotocol: 主要是为 uartcom + n服务的     驱动层到应用层缓存的过度
公用的串口通讯定义		
 	struct _s_protocol_ 的公共协议包(关键的结构体)的声明------struct _s_protocol_
 							void L1_uart_2buf(struct _s_protocol_ *p)串行数据保存到缓冲中
--------------------------------------------------------------------------------------------
msp/uartx.c    底层代码	 和cpu相关 
			L0_UART0_Init
						UART0_IRQHandler
						    	L0_Usend_uc----------s_at0
-----------------------------------------------------------------------------------------
********************************************************************************/

#include "tpc_modbus.h"
#include "../bsp/bsp_config.h"
#include "../ctask/TTSS_tick.h"
#include "c_lib.h"
///#include "app_config.h"

U8 L3_pack_modbus_03(TS_PH4_modbus *pmodbus ,U8 slaverId, U16 reg, U16 num)
{
	U8 bufsize = 4;
	pmodbus->slaver = slaverId;
	pmodbus->oper = MODBUS_OPER_READ;
	pmodbus->buf[0] = reg >> 8 & 0xFF;
	pmodbus->buf[1] = reg >> 0 & 0xFF;
	pmodbus->buf[2] = num >> 8 * 0xFF;
	pmodbus->buf[3] = num >> 0 & 0xFF;
	crc16(pmodbus->crc,&pmodbus->slaver,2 + bufsize);
	pmodbus->buf[bufsize] = pmodbus->crc[0];
	pmodbus->buf[bufsize + 1] = pmodbus->crc[1];

	return bufsize + 2 + 2;
}

U8 L3_pack_modbus_06(TS_PH4_modbus *pmodbus ,U8 slaverId, U16 reg, U8 *buf)
{
	U8 bufsize = 4;
	pmodbus->slaver = slaverId;
	pmodbus->oper = MODBUS_OPER_WRITE;
	pmodbus->buf[0] = reg >> 8 & 0xFF;
	pmodbus->buf[1] = reg >> 0 & 0xFF;
	pmodbus->buf[2] = buf[0];
	pmodbus->buf[3] = buf[1];
	crc16(pmodbus->crc,&pmodbus->slaver,2 + bufsize);
	pmodbus->buf[bufsize] = pmodbus->crc[0];
	pmodbus->buf[bufsize + 1] = pmodbus->crc[1];

	return bufsize + 2 + 2;
}

U8 L3_pack_modbus_10(TS_PH4_modbus *pmodbus ,U8 slaverId, U16 reg, U16 num, U8 bytes, U8 *buf)
{
	U8 bufsize = 5,i = 0;
	pmodbus->slaver = slaverId;
	pmodbus->oper = MODBUS_OPER_WRITE_M;
	pmodbus->buf[0] = reg >> 8 & 0xFF;
	pmodbus->buf[1] = reg >> 0 & 0xFF;
	pmodbus->buf[2] = num >> 8 * 0xFF;
	pmodbus->buf[3] = num >> 0 & 0xFF;
	pmodbus->buf[4] = bytes;

	for(i=0;i<bytes;i++)
	{
		pmodbus->buf[5+i] = buf[i];
	}
	crc16(pmodbus->crc,&pmodbus->slaver,2 + bufsize + bytes);
	pmodbus->buf[bufsize + bytes] = pmodbus->crc[0];
	pmodbus->buf[bufsize + bytes + 1] = pmodbus->crc[1];

	return bufsize + bytes + 2 + 2;
}

U8 L3_pack_modbus(TS_PH4_modbus *pmodbus, MD_SLAVER_INFO *slaver_info)
{
	switch(slaver_info->oper)
	{
	case MODBUS_OPER_READ:
		return L3_pack_modbus_03(pmodbus,slaver_info->slaver,slaver_info->reg,slaver_info->regnum);
	case MODBUS_OPER_WRITE:
		return L3_pack_modbus_06(pmodbus,slaver_info->slaver,slaver_info->reg,slaver_info->buf);
	case MODBUS_OPER_WRITE_M:
		return L3_pack_modbus_10(pmodbus,slaver_info->slaver,slaver_info->reg,slaver_info->regnum,slaver_info->bytes,slaver_info->buf);
	default:
		return 0;
	}
}

U8 L3_pack_modbusack(TS_PH4_modbus *pmodbus ,U8 slaver, U8 oper, U8 bufsize)
{
	pmodbus->slaver = slaver;
	pmodbus->oper = oper;
	crc16(pmodbus->crc,&pmodbus->slaver,2 + bufsize);
	pmodbus->buf[bufsize] = pmodbus->crc[0];
	pmodbus->buf[bufsize + 1] = pmodbus->crc[1];

	return bufsize + 2 + 2;
}

//MODBUS从设备数据处理函数
static Modbus03Ack *pModbus03Ack;
static Modbus06Ack *pModbus06Ack;
static Modbus10Ack *pModbus10Ack;
static U16 modbuslen = 0,reg,num,val,count;
U16 L3_modbus_slaver_ack(TS_PH4_modbus *pmodbus,TS_PH4_modbus *pModbusAck)
{
	switch(pmodbus->oper)
	{
	case MODBUS_OPER_READ:
	case MODBUS_OPER_READCONFIG:
	{
		U16 i = 0,j = 0,regval = 0;
		pModbus03Ack = (Modbus03Ack *)pModbusAck->buf;
		reg = ((U16)pmodbus->buf[0]) << 8 | ((U16)pmodbus->buf[1]);
		num = ((U16)pmodbus->buf[2]) << 8 | ((U16)pmodbus->buf[3]);
		if((num <= D_MODBUS_REG_MAX_NUM) && (reg <= sizeof(R)/2))	//每次最多读取D_MODBUS_REG_MAX_NUM个寄存器.防止越界
		{
			for(i=0; i<num; i++)
			{
				regval = *(REG_2_MEM(reg + i));
				pModbus03Ack->buf[j++] = regval >> 8 & 0xFF;
				pModbus03Ack->buf[j++] = regval & 0xFF;
			}
			pModbus03Ack->bytes = num * 2;
			modbuslen = L3_pack_modbusack(pModbusAck, pmodbus->slaver, pmodbus->oper, pModbus03Ack->bytes + 1);
		}
		break;
	}
	case MODBUS_OPER_WRITE:
	{	
		pModbus06Ack = (Modbus06Ack *)pModbusAck->buf;
		reg = ((U16)pmodbus->buf[0]) << 8 | ((U16)pmodbus->buf[1]);
		val = ((U16)pmodbus->buf[2]) << 8 | ((U16)pmodbus->buf[3]);
		if(reg <= sizeof(R)/2)
		{
			*(REG_2_MEM(reg)) = val;
			pModbus06Ack->reg = reg;
			pModbus06Ack->val = *(REG_2_MEM(reg));
			modbuslen = L3_pack_modbusack(pModbusAck, pmodbus->slaver, pmodbus->oper, 4);
		}
		break;
	}
	case MODBUS_OPER_WRITE_M:
	{
		U16 i = 0;
		pModbus10Ack = (Modbus10Ack *)pModbusAck->buf;
		reg = ((U16)pmodbus->buf[0]) << 8 | ((U16)pmodbus->buf[1]);
		num = ((U16)pmodbus->buf[2]) << 8 | ((U16)pmodbus->buf[3]);
		count = pmodbus->buf[4];
		if((num <= D_MODBUS_REG_MAX_NUM) && (reg < sizeof(R)/2))	//每次最多写入20个寄存器 40个字节，以防止越界
		{
			for(i=0; i<num; i++)
			{
				*(REG_2_MEM(reg + i)) = ((U16)pmodbus->buf[5+i*2]) << 8 | ((U16)pmodbus->buf[5+i*2+1]);
			}
			pModbus10Ack->reg = reg;
			pModbus10Ack->num = num;
			modbuslen = L3_pack_modbusack(pModbusAck, pmodbus->slaver, pmodbus->oper, 4);
		}
		break;
	}
	default:break;
	}
	return modbuslen;
}

//MODBUS主设备轮询时，从设备返回数据处理函数
//MD_SLAVER_INFO需要被正确定义
void L3_modbus_master_handler(TS_PH4_modbus *pmodbus,MD_SLAVER_INFO *p_slaver_info)
{
	switch(pmodbus->oper)
	{
		case MODBUS_OPER_READ:
		case MODBUS_OPER_READCONFIG:
		{
			U8 i = 0;
			for(i=0;i<pmodbus->buf[0];i++)
			{
				//此处假设字节序一致
				p_slaver_info->buf[i] = pmodbus->buf[i + 1];
				//TODO 字节序不一致时的处理
			}
			break;
		}
		case MODBUS_OPER_WRITE:
		case MODBUS_OPER_WRITE_M:
		default: break;
	}
}

//MODBUS协议解析函数
//超出D_tp_handle_x_len，不继续保存数据
void L1_s2b_PH4(Ts_uart_rev_ *p)
{	
	//p->modbusstmp = D_sys_now;
	if(p->head == 0)
	{
		p->head = 1;
		p->max = D_TPC_HANDLER_X_LEN;
		p->sp = p->buf;
		p->num = 0;
		p->sp[p->num++] = p->reg;
	}
	else
	{
		if(p->num < p->max)
		{
			p->sp[p->num++] = p->reg;
		}
	}
}

#if 0
//MODBUS协议分割函数，该函数应该被timer0中断调用
//本函数负责检查modbus crc，不负责校验业务ID
//校验业务ID，在具体的业务处理函数中实现
void L1_modbus_split(struct _tp_handler_x *p)
{
	if((p->head == 1) && (p->num >= D_s_modbus_min))
	{	
		crc16_irq(p->crc,p->buf,p->num - 2);	//校验CRC
		if(p->crc[0] == p->buf[p->num-2] && p->crc[1] == p->buf[p->num-1])
		{
			if(p->ok == 0)
			{
				p->ok = 1;
			}
		}
		p->head = 0;
	}
}
#endif

/******************************************************************************
**                            End Of File
******************************************************************************/