yunweiban_NB/source/tpc/tpc_modbus.c

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

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 "../clib/clib.h"

U8 L3_pack_modbus_03(TS_PH4_modbus *pmodbus ,U8 slaverId, U16 reg, U16 num)
{
	U8 bufsize = 4;
	pmodbus->salver = 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->salver,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->salver = 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->salver,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->salver = 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->salver,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)
{
	U8 pkglen = 0;
	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;
	}
}



void L1_s2b_PH4_init(TS_Handle_PH4 *p)
{	
	p->max = 0;
	p->ok = 0;
	p->head = 0;
	p->num = 0;
	p->error = 0;
}

void L1_s2b_PH4(TS_Handle_PH4 *p)
{	
	if(p->head == 0)
	{
		if(/*p->reg == p->slaver*/ 1)
		{
			p->head = 1;
			p->error = 0;
			p->max = D_s_PH4_modbus_max + 4;
			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;
		}
		else
		{
			//P10 ^= 1;
			p->error = 1;
		}
	}
}

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