|
/***********************************************************************************
//函 数 名:modbus_fun1
//功 能:功能码为1的数据处理,读取单个或多个线圈位操作
//输 入: 无
//输 出: 无
//说 明:
ID-功能码-首地址(2)-数据长度(2)-校验
ID-功能码-数据长度(1位,N)-数据(N)-校验
***********************************************************************************/
void modbus_fun1(uchar *dat){
uint tem1,tem2;
uchar tem3,tem5;
tem1=*(dat+2); //起始地址高位
tem1=(tem1<<8)|*(dat+3); //起始地址低位
tem2=*(dat+4); //寄存器数量高位
tem2=(tem2<<8)|*(dat+5); //寄存器数量低位
uchCRCHi = 0xFF ;
uchCRCLo = 0xFF ;
MODBUS_TXD(MODBUS_ID); //返回ID
MODBUS_TXD(*(dat+1)); //返回功能码
tem5=tem2/8;
if((tem2%8)!=0)tem5+=1;
MODBUS_TXD(tem5); //返回字节数量
tem2+=tem1; //换算成寄存器最后地址
tem3=0;tem5=0; //位计数,字节计数,返回的第一字节清0;
for(;tem1<tem2;tem1++){
if((*(modbus_dat_bit+(tem1/8))&(0x01<<(tem1%8)))!=0){
tem5|=(0x01<<tem3);
}
if(++tem3>7){tem3=0;MODBUS_TXD(tem5);tem5=0;} //8个位满了,字节数加1,同时清0
}
if(tem3!=0){MODBUS_TXD(tem5)} //不是8的倍数就还有数据
SBUF=uchCRCHi;while(!TI);TI=0; //返回CRC校验
SBUF=uchCRCLo;while(!TI);TI=0;
} |
|