函數輸入：兩個指針，pointer_1指向用來存放輸入信息幀的數組，
pointer_2用來指向存放輸出信息幀的數組（兩個數組的第一個元素都用來存放信息幀的有效字節個數）
后面的元素按照Modbus協議組織。 
函數輸出：無。 */

void ForceMulCoil(u8 *pointer_1,u8 *pointer_2)//pointer_1用作輸入，pointer_2用作輸出
{
u16 Address=0;//待強制線圈起始地址（GPIO_X,X為C，D兩個端口，每個端口16位，對應地址0——31）
u16 Num=0;//要強制的線圈個數
u8 ByteCount;//命令值的字節個數
u32 CommandValue;//命令的數值，有效的每個位用來置位或者復位指定地址的線圈
u32 PortTemp;//用來存放從端口取過來的數據
u32 CalTemp;//臨時計算用
u16 ReadData=0;//用來臨時存放從端口讀來的數據
u16 SendKey;//要發送數據的校驗值
u8 CountTemp;//計算實際需要的命令字節數

Address=(u16)(*(pointer_1+3))*256+(*(pointer_1+4));//先得到線圈地址
Num=(u16)(*(pointer_1+5))*256+(*(pointer_1+6));//先得到線圈數量
ByteCount= *(pointer_1+7);//表示命令值的字節數
CountTemp=(u8)(Num/8);
if(Num%8!=0)
CountTemp++;
*(pointer_2+2)=0x0F;//第三個字節為功能碼


if((*(pointer_1)==9+ByteCount)&&ByteCount>0&&ByteCount<=4&&CountTemp==ByteCount)//如果接收到的字節數不是預定的個數，或者命令字節數超出允許范圍就是一個錯誤幀
{

if(Address<32) //只要地址小于32，就是合法地址
{
if(Address+Num<=32&&Num>0) //只要地址加數量大于0小于32，就是合法數量
{
//用于for循環
u8 i;
u8 j;

//把命令值做一些處理，存入CommandValue
CommandValue=0;
for(i=0,j=ByteCount;j>0;i++,j--)
{
CommandValue|=((u32)*(pointer_1+8+i))<<8*i;//將輸入數據緩存中的數據存入CommandValue
}
CommandValue=CommandValue<<Address;//移動到對應起始位位置

*(pointer_2)=1+1+2+2+2;//有效字節個數等于叢機地址+功能碼+線圈起始地址+線圈數量+CRC校驗
*(pointer_2+3)=*(pointer_1+3);//將地址值寫入輸出的寄存器中
*(pointer_2+4)=*(pointer_1+4);
*(pointer_2+5)=*(pointer_1+5);//將線圈數量值寫入輸出的寄存器中
*(pointer_2+6)=*(pointer_1+6);

//將端口C和D的數據預先讀入到臨時的數據緩存中
ReadData=GPIO_ReadOutputData(GPIOD);
PortTemp=(u32)(ReadData);
PortTemp=PortTemp<<16;
ReadData=GPIO_ReadOutputData(GPIOC);
PortTemp=PortTemp|(u32)(ReadData);

//將需要讀出來的數據按要求處理
CalTemp=0xFFFFFFFF<<32-Num;
CalTemp=CalTemp>>32-Num-Address;
CalTemp=~CalTemp;
PortTemp&=CalTemp;
PortTemp|=CommandValue;

//再將數據寫入
GPIO_Write(GPIOC,(u16)(PortTemp&0x0000FFFF));
GPIO_Write(GPIOD,(u16)(PortTemp>>16));

//寫入校驗碼
SendKey=CRC16(pointer_2+1,*pointer_2-2);
//將計算出來的校驗碼裝入輸出數據緩存中
*(pointer_2+(*pointer_2-1))=(u8)(SendKey>>8);
*(pointer_2+(*pointer_2))=(u8)(SendKey&0x00FF);

//啟動數據發送
USART_ITConfig(USART1, USART_IT_TC, ENABLE);//開啟數據發送中斷

}
else
{
ErrorHandle(3,pointer_2);//錯誤讀取數量
}
}
else
{
ErrorHandle(2,pointer_2);//錯誤起始地址
}
}
else
{
Comu_Busy=0;
}
}




void PresetMulReg(u8 *pointer_1,u8 *pointer_2)//pointer_1用作輸入，pointer_2用作輸出
{
u16 Address=0;//待預制寄存器的起始地址（HoldReg[i],i為0-99對應地址從0到99）
u16 Num=0;//要預制的寄存器數量
u8 ByteCount;//預制值的字節個數
u16 PresetValue=0;//預制數值
u16 SendKey;//要發送數據的校驗值


Address=(u16)(*(pointer_1+3))*256+(*(pointer_1+4));//先得到寄存器地址
Num=(u16)(*(pointer_1+5))*256+(*(pointer_1+6));//先得到待預制寄存器數量
*(pointer_2+2)=0x10;//第三個字節為功能碼
ByteCount= *(pointer_1+7);//表示命令值的字節數

if((*(pointer_1)==9+ByteCount)&&ByteCount>0&&ByteCount<=200&&ByteCount==(u8)(Num*2))//如果接收到的字節數不是預定的個數，或者命令字節數超出允許范圍就是一個錯誤幀
{

if(Address<100) //只要地址小于100，就是合法地址
{

if(Address+Num<=100&&Num>0) //只要地址加數量大于0小于100，就是合法數量
{
//用于for循環
u8 i;
u8 j;

*(pointer_2)=1+1+2+2+2;//有效字節個數等于叢機地址+功能碼+寄存器地址+寄存器數量+CRC校驗
*(pointer_2+3)=*(pointer_1+3);//將地址值寫入輸出的寄存器中
*(pointer_2+4)=*(pointer_1+4);
*(pointer_2+5)=*(pointer_1+5);//將數量寫入輸出寄存器中
*(pointer_2+6)=*(pointer_1+6);

for(i=0,j=0;i 
{
PresetValue=(u16)(*(pointer_1+8+j))*256+(*(pointer_1+9+j));//先得到預制值
HoldReg[Address+i]=PresetValue;//將預制值寫入保持寄存器
}


//寫入校驗碼
SendKey=CRC16(pointer_2+1,*pointer_2-2);
//將計算出來的校驗碼裝入輸出數據緩存中
*(pointer_2+(*pointer_2-1))=(u8)(SendKey>>8);
*(pointer_2+(*pointer_2))=(u8)(SendKey&0x00FF);

//啟動數據發送
USART_ITConfig(USART1, USART_IT_TC, ENABLE);//開啟數據發送中斷

}
else
{
ErrorHandle(3,pointer_2);//錯誤讀取數量
}

}
else
{
ErrorHandle(2,pointer_2);//錯誤起始地址
}
}
else
{
Comu_Busy=0;
}
}




void ErrorHandle(u8 Mode,u8 *Pointer)
{
u16 SendKey;//要發送數據的校驗值

HaveMes=0;//清除信息位
TIM_Cmd(TIM2,DISABLE);
TIM_SetCounter(TIM3,0);
Rcv_Complete=1;
Comu_Busy=1;
Rcv_Buffer[0]=Rcv_Num;
switch(Mode)
{
case 1:*(Pointer+3)=0x01;//錯誤功能碼
break; 
case 2:*(Pointer+3)=0x02;//錯誤地址
break;
case 3:*(Pointer+3)=0x03;//錯誤數據
break;
case 6:*(Pointer+3)=0x06;//從設備忙
break;
}
*Pointer=0x05;//輸出寄存器有效數據個數
*(Pointer+2)|=0x80;//功能碼最高位置一
//寫入校驗碼
SendKey=CRC16(Pointer+1,*Pointer-2);
//將計算出來的校驗碼裝入輸出數據緩存中
*(Pointer+(*Pointer-1))=(u8)(SendKey>>8);
*(Pointer+(*Pointer))=(u8)(SendKey&0x00FF);

//啟動數據發送
USART_ITConfig(USART1, USART_IT_TC, ENABLE);//開啟數據發送中斷 
}