#include "modbus.h"
|
#include "Rcc_Nvic_Systick.h"
|
///////////////////////////////////////////////////////////
|
//u32 RS485_Baudrate=9600;//ͨѶ²¨ÌØÂÊ
|
//u8 RS485_Parity=0;//0ÎÞУÑ飻1ÆæУÑ飻2żУÑé
|
u8 RS485_Addr=1;//´Ó»úµØÖ·
|
//u16 RS485_Frame_Distance=4;//Êý¾ÝÖ¡×îС¼ä¸ô£¨ms),³¬¹ý´Ëʱ¼äÔòÈÏΪÊÇÏÂÒ»Ö¡
|
|
u8 cmd_mode = 0;
|
|
u8 RS485_RX_BUFF[200];//½ÓÊÕ»º³åÇø200×Ö½Ú
|
u16 RS485_RX_CNT=0;//½ÓÊÕ¼ÆÊýÆ÷
|
//u8 RS485_FrameFlag=0;//Ö¡½áÊø±ê¼Ç
|
u8 RS485_TX_BUFF[200];//·¢ËÍ»º³åÇø
|
u16 RS485_TX_CNT=0;//·¢ËͼÆÊýÆ÷
|
|
//u8 DATA_RX_BUFF[2048];//½ÓÊÕ»º´æ£»
|
////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
//Modbus¼Ä´æÆ÷ºÍµ¥Æ¬»ú¼Ä´æÆ÷µÄÓ³Éä¹Øϵ
|
vu32 *Modbus_InputIO[100];//ÊäÈ뿪¹ØÁ¿¼Ä´æÆ÷Ö¸Õë(ÕâÀïʹÓõÄÊÇλ´ø²Ù×÷)
|
vu32 *Modbus_OutputIO[100];//Êä³ö¿ª¹ØÁ¿¼Ä´æÆ÷Ö¸Õë(ÕâÀïʹÓõÄÊÇλ´ø²Ù×÷)
|
u16 Modbus_HoldReg[MODBUS_SIZE];//±£³Ö¼Ä´æÆ÷Ö¸Õë
|
u32 testData1=1201,testData2=1002,testData3=2303,testData4=8204;
|
void Modbus_RegMap(void)
|
{
|
u16 i;
|
for(i=0; i<MODBUS_SIZE; i++)
|
{
|
Modbus_HoldReg[i]=i;
|
}
|
//ÊäÈ뿪¹ØÁ¿¼Ä´æÆ÷Ö¸ÕëÖ¸Ïò
|
// Modbus_InputIO[0]=(vu32*)&PEin(4);//KEY0 //&PEin(4)£ºÈ¡PE4µÄµØÖ·£¬(vu32*)&PEin(4)½«PE4µØÖ·Ç¿ÖÆת»»Îªuw32ÀàÐ͵ĵØÖ·£¬Modbus_InputIO[0]=(vu32*)&PEin(4); ½«×ª»»ºÃµÄµØÖ·Ë͸øµØÖ·Ö¸ÕëModbus_InputIO[0]£»
|
// Modbus_InputIO[1]=(vu32*)&PEin(3);//KEY1 //*Modbus_InputIO[0] È¡³öµØÖ·ÖеÄÄÚÈÝ¡£
|
// Modbus_InputIO[2]=(vu32*)&PEin(2);//KEY2
|
// Modbus_InputIO[3]=(vu32*)&PAin(0);//KEY3
|
|
//Êä³ö¿ª¹ØÁ¿¼Ä´æÆ÷Ö¸ÕëÖ¸Ïò
|
// Modbus_OutputIO[0]=(vu32*)&PBout(5);//LED0
|
// Modbus_OutputIO[1]=(vu32*)&PEout(5);//LED1
|
|
//±£³Ö¼Ä´æÆ÷Ö¸ÕëÖ¸Ïò
|
// Modbus_HoldReg[0]=(u16*)&testData1;//²âÊÔÊý¾Ý1
|
// Modbus_HoldReg[1]=(u16*)&testData2;//((u16*)&testData1)+1;//²âÊÔÊý¾Ý1
|
// Modbus_HoldReg[2]=(u16*)&testData3;//(u16*)&testData2;//²âÊÔÊý¾Ý2
|
// Modbus_HoldReg[3]=(u16*)&testData4;//((u16*)&testData2)+1;//²âÊÔÊý¾Ý2
|
// Modbus_HoldReg[4]=(u16*)&testData1;
|
// Modbus_HoldReg[5]=(u16*)&testData2;
|
// Modbus_HoldReg[6]=(u16*)&testData3;
|
|
}
|
/////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
//CRCУÑé ×Ô¼ººóÃæÌí¼ÓµÄ
|
|
const u8 auchCRCHi[] = {
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
|
0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40,
|
0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40,
|
0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
|
0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
|
0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40,
|
0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
|
0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,0x80, 0x41, 0x00, 0xC1, 0x81, 0x40
|
} ;
|
|
|
const u8 auchCRCLo[] = {
|
0x00, 0xC0, 0xC1, 0x01, 0xC3, 0x03, 0x02, 0xC2, 0xC6, 0x06,0x07, 0xC7, 0x05, 0xC5, 0xC4, 0x04, 0xCC, 0x0C, 0x0D, 0xCD,
|
0x0F, 0xCF, 0xCE, 0x0E, 0x0A, 0xCA, 0xCB, 0x0B, 0xC9, 0x09,0x08, 0xC8, 0xD8, 0x18, 0x19, 0xD9, 0x1B, 0xDB, 0xDA, 0x1A,
|
0x1E, 0xDE, 0xDF, 0x1F, 0xDD, 0x1D, 0x1C, 0xDC, 0x14, 0xD4,0xD5, 0x15, 0xD7, 0x17, 0x16, 0xD6, 0xD2, 0x12, 0x13, 0xD3,
|
0x11, 0xD1, 0xD0, 0x10, 0xF0, 0x30, 0x31, 0xF1, 0x33, 0xF3,0xF2, 0x32, 0x36, 0xF6, 0xF7, 0x37, 0xF5, 0x35, 0x34, 0xF4,
|
0x3C, 0xFC, 0xFD, 0x3D, 0xFF, 0x3F, 0x3E, 0xFE, 0xFA, 0x3A,0x3B, 0xFB, 0x39, 0xF9, 0xF8, 0x38, 0x28, 0xE8, 0xE9, 0x29,
|
0xEB, 0x2B, 0x2A, 0xEA, 0xEE, 0x2E, 0x2F, 0xEF, 0x2D, 0xED,0xEC, 0x2C, 0xE4, 0x24, 0x25, 0xE5, 0x27, 0xE7, 0xE6, 0x26,
|
0x22, 0xE2, 0xE3, 0x23, 0xE1, 0x21, 0x20, 0xE0, 0xA0, 0x60,0x61, 0xA1, 0x63, 0xA3, 0xA2, 0x62, 0x66, 0xA6, 0xA7, 0x67,
|
0xA5, 0x65, 0x64, 0xA4, 0x6C, 0xAC, 0xAD, 0x6D, 0xAF, 0x6F,0x6E, 0xAE, 0xAA, 0x6A, 0x6B, 0xAB, 0x69, 0xA9, 0xA8, 0x68,
|
0x78, 0xB8, 0xB9, 0x79, 0xBB, 0x7B, 0x7A, 0xBA, 0xBE, 0x7E,0x7F, 0xBF, 0x7D, 0xBD, 0xBC, 0x7C, 0xB4, 0x74, 0x75, 0xB5,
|
0x77, 0xB7, 0xB6, 0x76, 0x72, 0xB2, 0xB3, 0x73, 0xB1, 0x71,0x70, 0xB0, 0x50, 0x90, 0x91, 0x51, 0x93, 0x53, 0x52, 0x92,
|
0x96, 0x56, 0x57, 0x97, 0x55, 0x95, 0x94, 0x54, 0x9C, 0x5C,0x5D, 0x9D, 0x5F, 0x9F, 0x9E, 0x5E, 0x5A, 0x9A, 0x9B, 0x5B,
|
0x99, 0x59, 0x58, 0x98, 0x88, 0x48, 0x49, 0x89, 0x4B, 0x8B,0x8A, 0x4A, 0x4E, 0x8E, 0x8F, 0x4F, 0x8D, 0x4D, 0x4C, 0x8C,
|
0x44, 0x84, 0x85, 0x45, 0x87, 0x47, 0x46, 0x86, 0x82, 0x42,0x43, 0x83, 0x41, 0x81, 0x80, 0x40
|
} ;
|
|
|
u16 CRC_Compute(u8 *puchMsg, u16 usDataLen)
|
{
|
u8 uchCRCHi = 0xFF ;
|
u8 uchCRCLo = 0xFF ;
|
u32 uIndex ;
|
while (usDataLen--)
|
{
|
uIndex = uchCRCHi ^ *puchMsg++ ;
|
uchCRCHi = uchCRCLo ^ auchCRCHi[uIndex] ;
|
uchCRCLo = auchCRCLo[uIndex] ;
|
}
|
return ((uchCRCHi<< 8) | (uchCRCLo)) ;
|
}//uint16 crc16(uint8 *puchMsg, uint16 usDataLen)
|
////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
|
//³õʼ»¯USART2
|
void RS485_Init(void)
|
{
|
GPIO_InitTypeDef GPIO_InitStructure;
|
// USART_InitTypeDef USART_InitStructure;
|
// NVIC_InitTypeDef NVIC_InitStructure;
|
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB,ENABLE);
|
// RCC_APB1PeriphClockCmd(RCC_APB1Periph_USART2,ENABLE);
|
|
// GPIO_InitStructure.GPIO_Pin=GPIO_Pin_2;//PA2£¨TX£©¸´ÓÃÍÆÍìÊä³ö
|
// GPIO_InitStructure.GPIO_Mode=GPIO_Mode_AF_PP;
|
GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz;
|
// GPIO_Init(GPIOA,&GPIO_InitStructure);
|
// GPIO_SetBits(GPIOA,GPIO_Pin_2);//ĬÈϸߵçƽ
|
//
|
// GPIO_InitStructure.GPIO_Pin=GPIO_Pin_3;//PA3£¨RX£©ÊäÈëÉÏÀ
|
// GPIO_InitStructure.GPIO_Mode=GPIO_Mode_IN_FLOATING; //ÐÞ¸ÄÔGPIO_Mode_IPU£¨ÊäÈëÉÏÀ£©->GPIO_Mode_IN_FLOATING(¸¡¿ÕÊäÈë)/////////////////////////////////////////////
|
// GPIO_Init(GPIOA,&GPIO_InitStructure);
|
|
GPIO_InitStructure.GPIO_Pin=RS485_TX_PIN;//ÐÞ¸ÄPG9£¨RE/DE£©Í¨ÓÃÍÆÍìÊä³ö->PB7£¨RE/DE£©Í¨ÓÃÍÆÍìÊä³ö//////////////////////////////////////////////////////////////////////
|
GPIO_InitStructure.GPIO_Mode=GPIO_Mode_Out_PP;
|
GPIO_Init(RS485_TX_GPIO,&GPIO_InitStructure);
|
GPIO_ResetBits(RS485_TX_GPIO,RS485_TX_PIN);//ĬÈϽÓÊÕ״̬
|
|
// USART_DeInit(USART2);//¸´Î»´®¿Ú2
|
// USART_InitStructure.USART_BaudRate=RS485_Baudrate;
|
// USART_InitStructure.USART_HardwareFlowControl=USART_HardwareFlowControl_None;
|
// USART_InitStructure.USART_WordLength=USART_WordLength_8b;
|
// USART_InitStructure.USART_StopBits=USART_StopBits_1;
|
// USART_InitStructure.USART_Mode=USART_Mode_Rx|USART_Mode_Tx;//ÊÕ·¢Ä£Ê½
|
// switch(RS485_Parity)
|
// {
|
// case 0:USART_InitStructure.USART_Parity=USART_Parity_No;break;//ÎÞУÑé
|
// case 1:USART_InitStructure.USART_Parity=USART_Parity_Odd;break;//ÆæУÑé
|
// case 2:USART_InitStructure.USART_Parity=USART_Parity_Even;break;//żУÑé
|
// }
|
// USART_Init(USART2,&USART_InitStructure);
|
//
|
// USART_ClearITPendingBit(USART2,USART_IT_RXNE);
|
// USART_ITConfig(USART2,USART_IT_RXNE,ENABLE);//ʹÄÜ´®¿Ú2½ÓÊÕÖжÏ
|
//
|
// NVIC_InitStructure.NVIC_IRQChannel=USART2_IRQn;
|
// NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=2;
|
// NVIC_InitStructure.NVIC_IRQChannelSubPriority=2;
|
// NVIC_InitStructure.NVIC_IRQChannelCmd=ENABLE;
|
// NVIC_Init(&NVIC_InitStructure);
|
//
|
// USART_Cmd(USART2,ENABLE);//ʹÄÜ´®¿Ú2
|
// RS485_TX_OFF;//ĬÈÏΪ½ÓÊÕģʽ
|
|
// Timer7_Init();//¶¨Ê±Æ÷7³õʼ»¯£¬ÓÃÓÚ¼àÊÓ¿ÕÏÐʱ¼ä
|
Modbus_RegMap();//Modbus¼Ä´æÆ÷Ó³Éä
|
}
|
|
//¶¨Ê±Æ÷7³õʼ»¯
|
//void Timer7_Init(void)
|
//{
|
// TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
|
// NVIC_InitTypeDef NVIC_InitStructure;
|
|
// RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM7, ENABLE); //TIM7ʱÖÓʹÄÜ
|
|
// //TIM7³õʼ»¯ÉèÖÃ
|
// TIM_TimeBaseStructure.TIM_Period = RS485_Frame_Distance*10; //ÉèÖÃÔÚÏÂÒ»¸ö¸üÐÂʼþ×°Èë»î¶¯µÄ×Ô¶¯ÖØ×°ÔؼĴæÆ÷ÖÜÆÚµÄÖµ
|
// TIM_TimeBaseStructure.TIM_Prescaler =7200; //ÉèÖÃÓÃÀ´×÷ΪTIMxʱÖÓƵÂʳýÊýµÄÔ¤·ÖƵֵ ÉèÖüÆÊýƵÂÊΪ10kHz
|
// TIM_TimeBaseStructure.TIM_ClockDivision = 0; //ÉèÖÃʱÖÓ·Ö¸î:TDTS = Tck_tim
|
// TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //TIMÏòÉϼÆÊýģʽ
|
// TIM_TimeBaseInit(TIM7, &TIM_TimeBaseStructure); //¸ù¾ÝTIM_TimeBaseInitStructÖÐÖ¸¶¨µÄ²ÎÊý³õʼ»¯TIMxµÄʱ¼ä»ùÊýµ¥Î»
|
|
// TIM_ITConfig( TIM7, TIM_IT_Update, ENABLE );//TIM7 ÔÊÐí¸üÐÂÖжÏ
|
|
// //TIM7ÖжϷÖ×éÅäÖÃ
|
// NVIC_InitStructure.NVIC_IRQChannel =TIM7_IRQn; //TIM7ÖжÏ
|
// NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 2; //ÏÈÕ¼ÓÅÏȼ¶2¼¶
|
// NVIC_InitStructure.NVIC_IRQChannelSubPriority = 3; //´ÓÓÅÏȼ¶3¼¶
|
// NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQͨµÀ±»Ê¹ÄÜ
|
// NVIC_Init(&NVIC_InitStructure); //¸ù¾ÝNVIC_InitStructÖÐÖ¸¶¨µÄ²ÎÊý³õʼ»¯ÍâÉèNVIC¼Ä´æÆ÷
|
//}
|
|
|
|
//////////////////////////////////////////////////////////////////////////////
|
//·¢ËÍn¸ö×Ö½ÚÊý¾Ý
|
//buff:·¢ËÍÇøÊ×µØÖ·
|
//len£º·¢Ë͵Ä×Ö½ÚÊý
|
//void RS485_SendData(u8 *buff,u8 len)
|
//{
|
// RS485_TX_ON;//Çл»Îª·¢ËÍģʽ
|
// #ifdef BAUDRATE_19200
|
// delay_ms(5);
|
// #else
|
// delay_ms(1);
|
// #endif
|
// while(len--)
|
// {
|
// while(USART_GetFlagStatus(USART1,USART_FLAG_TXE)==RESET);//µÈ´ý·¢ËÍÇøΪ¿Õ
|
// USART_SendData(USART1,*(buff++));
|
// }
|
// while(USART_GetFlagStatus(USART1,USART_FLAG_TC)==RESET);//µÈ´ý·¢ËÍÍê³É
|
// RS485_TX_OFF;//¿ªÆô½ÓÊÕģʽ
|
//}
|
|
|
/////////////////////////////////////////////////////////////////////////////////////
|
//void USART2_IRQHandler(void)//´®¿Ú2ÖжϷþÎñ³ÌÐò
|
//{
|
//
|
// u8 res;
|
// u8 err;
|
//
|
// if(USART_GetITStatus(USART2,USART_IT_RXNE)!=RESET)
|
// {
|
// if(USART_GetFlagStatus(USART2,USART_FLAG_NE|USART_FLAG_FE|USART_FLAG_PE)) err=1;//¼ì²âµ½ÔëÒô¡¢Ö¡´íÎó»òУÑé´íÎó
|
// else err=0;
|
// //LED0=0;
|
// res=USART_ReceiveData(USART2); //¶Á½ÓÊÕµ½µÄ×Ö½Ú£¬Í¬Ê±Ïà¹Ø±êÖ¾×Ô¶¯Çå³ý
|
//
|
// if((RS485_RX_CNT<2047)&&(err==0))
|
// {
|
// RS485_RX_BUFF[RS485_RX_CNT]=res;
|
// RS485_RX_CNT++;
|
//
|
// TIM_ClearITPendingBit(TIM7,TIM_IT_Update);//Çå³ý¶¨Ê±Æ÷Òç³öÖжÏ
|
// TIM_SetCounter(TIM7,0);//µ±½ÓÊÕµ½Ò»¸öеÄ×Ö½Ú£¬½«¶¨Ê±Æ÷7¸´Î»Îª0£¬ÖØмÆʱ£¨Ï൱ÓÚι¹·£©
|
// TIM_Cmd(TIM7,ENABLE);//¿ªÊ¼¼Æʱ
|
// }
|
// }
|
//}
|
|
///////////////////////////////////////////////////////////////////////////////////////
|
//Óö¨Ê±Æ÷7ÅжϽÓÊÕ¿ÕÏÐʱ¼ä£¬µ±¿ÕÏÐʱ¼ä´óÓÚÖ¸¶¨Ê±¼ä£¬ÈÏΪһ֡½áÊø
|
//¶¨Ê±Æ÷7ÖжϷþÎñ³ÌÐò
|
//void TIM7_IRQHandler(void)
|
//{
|
// if(TIM_GetITStatus(TIM7,TIM_IT_Update)!=RESET)
|
// {
|
// TIM_ClearITPendingBit(TIM7,TIM_IT_Update);//Çå³ýÖжϱêÖ¾
|
// TIM_Cmd(TIM7,DISABLE);//Í£Ö¹¶¨Ê±Æ÷
|
// RS485_TX_ON;//Í£Ö¹½ÓÊÕ£¬Çл»Îª·¢ËÍ״̬
|
// RS485_FrameFlag=1;//ÖÃλ֡½áÊø±ê¼Ç
|
// }
|
//}
|
|
/////////////////////////////////////////////////////////////////////////////////////
|
//RS485·þÎñ³ÌÐò£¬ÓÃÓÚ´¦Àí½ÓÊÕµ½µÄÊý¾Ý(ÇëÔÚÖ÷º¯ÊýÖÐÑ»·µ÷ÓÃ)
|
u16 startRegAddr;
|
u16 RegNum;
|
u16 calCRC;
|
void RS485_Service(void)
|
{
|
u16 recCRC;
|
//if(RS485_FrameFlag==1)
|
//{
|
if(RS485_RX_BUFF[0]==RS485_Addr)//µØÖ·ÕýÈ·
|
{
|
//if((RS485_RX_BUFF[1]==01)||(RS485_RX_BUFF[1]==02)||(RS485_RX_BUFF[1]==03)||(RS485_RX_BUFF[1]==05)||(RS485_RX_BUFF[1]==06)||(RS485_RX_BUFF[1]==15)||(RS485_RX_BUFF[1]==16))//¹¦ÄÜÂëÕýÈ·
|
if((RS485_RX_BUFF[1]==03)||(RS485_RX_BUFF[1]==06)||(RS485_RX_BUFF[1]==16))
|
{
|
startRegAddr=(((u16)RS485_RX_BUFF[2])<<8)|RS485_RX_BUFF[3];//»ñÈ¡¼Ä´æÆ÷ÆðʼµØÖ·
|
if(startRegAddr<MODBUS_SIZE)//¼Ä´æÆ÷µØÖ·ÔÚ·¶Î§ÄÚ
|
{
|
if(RS485_RX_BUFF[1]==16)
|
{
|
RS485_RX_CNT=RS485_RX_BUFF[6]+9;//½ÓÊÕÊý¾Ý³¤¶È
|
}
|
else
|
{
|
RS485_RX_CNT = 8;//Êý¾Ý³¤¶È
|
}
|
calCRC=CRC_Compute(RS485_RX_BUFF,RS485_RX_CNT-2);//¼ÆËãËù½ÓÊÕÊý¾ÝµÄCRC
|
recCRC=RS485_RX_BUFF[RS485_RX_CNT-1]|(((u16)RS485_RX_BUFF[RS485_RX_CNT-2])<<8);//½ÓÊÕµ½µÄCRC(µÍ×Ö½ÚÔÚÇ°£¬¸ß×Ö½ÚÔÚºó)
|
if(calCRC==recCRC)//CRCУÑéÕýÈ·
|
{
|
//LED1=0;
|
/////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
switch(RS485_RX_BUFF[1])//¸ù¾Ý²»Í¬µÄ¹¦ÄÜÂë½øÐд¦Àí
|
{
|
// case 2://¶ÁÊäÈ뿪¹ØÁ¿
|
// {
|
// Modbus_02_Solve();
|
// break;
|
// }
|
|
// case 1://¶ÁÊä³ö¿ª¹ØÁ¿
|
// {
|
// Modbus_01_Solve();
|
// break;
|
// }
|
|
// case 5://дµ¥¸öÊä³ö¿ª¹ØÁ¿
|
// {
|
// Modbus_05_Solve();
|
// break;
|
// }
|
//
|
// case 15://д¶à¸öÊä³ö¿ª¹ØÁ¿
|
// {
|
// Modbus_15_Solve();
|
// break;
|
// }
|
|
case 03: //¶Á¶à¸ö¼Ä´æÆ÷
|
{
|
Modbus_03_Solve();
|
break;
|
}
|
|
case 06: //дµ¥¸ö¼Ä´æÆ÷
|
{
|
Modbus_06_Solve();
|
break;
|
}
|
|
case 16: //д¶à¸ö¼Ä´æÆ÷
|
{
|
Modbus_16_Solve();
|
break;
|
}
|
|
}
|
//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
|
}
|
else//CRCУÑé´íÎó
|
{
|
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1]|0x80;
|
RS485_TX_BUFF[2]=0x04; //Òì³£Âë
|
UART_PushFrame(RS485_TX_BUFF,3);
|
cmd_mode = 0;//ÐÒé´¦ÀíÍê³É
|
}
|
}
|
else//¼Ä´æÆ÷µØÖ·³¬³ö·¶Î§
|
{
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1]|0x80;
|
RS485_TX_BUFF[2]=0x02; //Òì³£Âë
|
UART_PushFrame(RS485_TX_BUFF,3);
|
cmd_mode = 0;//ÐÒé´¦ÀíÍê³É
|
}
|
}
|
else//¹¦ÄÜÂë´íÎó
|
{
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1]|0x80;
|
RS485_TX_BUFF[2]=0x01; //Òì³£Âë
|
UART_PushFrame(RS485_TX_BUFF,3);
|
cmd_mode = 0;//ÐÒé´¦ÀíÍê³É
|
}
|
}
|
|
//RS485_FrameFlag=0;//¸´Î»Ö¡½áÊø±êÖ¾
|
RS485_RX_CNT=0;//½ÓÊÕ¼ÆÊýÆ÷ÇåÁã
|
cmd_mode = 0;//ÐÒé´¦ÀíÍê³É
|
//}
|
}
|
|
//Modbus¹¦ÄÜÂë02´¦Àí³ÌÐò/////////////////////////////////////////////////////³ÌÐòÒÑÑéÖ¤OK -----±ØÐëÏÈÅäÖÃPE4 PE3 PE2 PA0 ³õʼ»¯°´¼ü²Å¿ÉÒÔOK KEY_Init();
|
//¶ÁÊäÈ뿪¹ØÁ¿
|
void Modbus_02_Solve(void)
|
{
|
u16 ByteNum;
|
u16 i;
|
RegNum= (((u16)RS485_RX_BUFF[4])<<8)|RS485_RX_BUFF[5];//»ñÈ¡¼Ä´æÆ÷ÊýÁ¿
|
if((startRegAddr+RegNum)<100)//¼Ä´æÆ÷µØÖ·+ÊýÁ¿ÔÚ·¶Î§ÄÚ
|
{
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1];
|
ByteNum=RegNum/8;//×Ö½ÚÊý
|
if(RegNum%8) ByteNum+=1;//Èç¹ûλÊý»¹ÓÐÓàÊý£¬Ôò×Ö½ÚÊý+1
|
RS485_TX_BUFF[2]=ByteNum;//·µ»ØÒª¶ÁÈ¡µÄ×Ö½ÚÊý
|
for(i=0; i<RegNum; i++)
|
{
|
if(i%8==0) RS485_TX_BUFF[3+i/8]=0x00;
|
RS485_TX_BUFF[3+i/8]>>=1;//µÍλÏÈ·¢ËÍ
|
RS485_TX_BUFF[3+i/8]|=((*Modbus_InputIO[startRegAddr+i])<<7)&0x80;
|
if(i==RegNum-1)//·¢Ë͵½×îºóÒ»¸öλÁË
|
{
|
if(RegNum%8) RS485_TX_BUFF[3+i/8]>>=8-(RegNum%8);//Èç¹û×îºóÒ»¸ö×Ö½Ú»¹ÓÐÓàÊý£¬ÔòÊ£ÓàMSBÌî³ä0
|
}
|
}
|
calCRC=CRC_Compute(RS485_TX_BUFF,ByteNum+3);
|
RS485_TX_BUFF[ByteNum+3]=(calCRC>>8)&0xFF;
|
RS485_TX_BUFF[ByteNum+4]=(calCRC)&0xFF;
|
UART_PushFrame(RS485_TX_BUFF,ByteNum+5);
|
}
|
else//¼Ä´æÆ÷µØÖ·+ÊýÁ¿³¬³ö·¶Î§
|
{
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1]|0x80;
|
RS485_TX_BUFF[2]=0x02; //Òì³£Âë
|
UART_PushFrame(RS485_TX_BUFF,3);
|
}
|
}
|
|
//Modbus¹¦ÄÜÂë01´¦Àí³ÌÐò ///////////////////////////////////////////////////////////³ÌÐòÒÑÑéÖ¤OK
|
//¶ÁÊä³ö¿ª¹ØÁ¿
|
void Modbus_01_Solve(void)
|
{
|
u16 ByteNum;
|
u16 i;
|
RegNum= (((u16)RS485_RX_BUFF[4])<<8)|RS485_RX_BUFF[5];//»ñÈ¡¼Ä´æÆ÷ÊýÁ¿
|
if((startRegAddr+RegNum)<100)//¼Ä´æÆ÷µØÖ·+ÊýÁ¿ÔÚ·¶Î§ÄÚ
|
{
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1];
|
ByteNum=RegNum/8;//×Ö½ÚÊý
|
if(RegNum%8) ByteNum+=1;//Èç¹ûλÊý»¹ÓÐÓàÊý£¬Ôò×Ö½ÚÊý+1
|
RS485_TX_BUFF[2]=ByteNum;//·µ»ØÒª¶ÁÈ¡µÄ×Ö½ÚÊý
|
for(i=0; i<RegNum; i++)
|
{
|
if(i%8==0) RS485_TX_BUFF[3+i/8]=0x00;
|
RS485_TX_BUFF[3+i/8]>>=1;//µÍλÏÈ·¢ËÍ
|
RS485_TX_BUFF[3+i/8]|=((*Modbus_OutputIO[startRegAddr+i])<<7)&0x80;
|
if(i==RegNum-1)//·¢Ë͵½×îºóÒ»¸öλÁË
|
{
|
if(RegNum%8) RS485_TX_BUFF[3+i/8]>>=8-(RegNum%8);//Èç¹û×îºóÒ»¸ö×Ö½Ú»¹ÓÐÓàÊý£¬ÔòÊ£ÓàMSBÌî³ä0
|
}
|
}
|
calCRC=CRC_Compute(RS485_TX_BUFF,ByteNum+3);
|
RS485_TX_BUFF[ByteNum+3]=(calCRC>>8)&0xFF;
|
RS485_TX_BUFF[ByteNum+4]=(calCRC)&0xFF;
|
UART_PushFrame(RS485_TX_BUFF,ByteNum+5);
|
}
|
else//¼Ä´æÆ÷µØÖ·+ÊýÁ¿³¬³ö·¶Î§
|
{
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1]|0x80;
|
RS485_TX_BUFF[2]=0x02; //Òì³£Âë
|
UART_PushFrame(RS485_TX_BUFF,3);
|
}
|
}
|
|
//Modbus¹¦ÄÜÂë05´¦Àí³ÌÐò ///////////////////////////////////////////////////////³ÌÐòÒÑÑéÖ¤OK
|
//дµ¥¸öÊä³ö¿ª¹ØÁ¿
|
void Modbus_05_Solve(void)
|
{
|
if(startRegAddr<100)//¼Ä´æÆ÷µØÖ·ÔÚ·¶Î§ÄÚ
|
{
|
if((RS485_RX_BUFF[4]==0xFF)||(RS485_RX_BUFF[5]==0xFF)) *Modbus_OutputIO[startRegAddr]=0x01;
|
else *Modbus_OutputIO[startRegAddr]=0x00;
|
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1];
|
RS485_TX_BUFF[2]=RS485_RX_BUFF[2];
|
RS485_TX_BUFF[3]=RS485_RX_BUFF[3];
|
RS485_TX_BUFF[4]=RS485_RX_BUFF[4];
|
RS485_TX_BUFF[5]=RS485_RX_BUFF[5];
|
|
calCRC=CRC_Compute(RS485_TX_BUFF,6);
|
RS485_TX_BUFF[6]=(calCRC>>8)&0xFF;
|
RS485_TX_BUFF[7]=(calCRC)&0xFF;
|
UART_PushFrame(RS485_TX_BUFF,8);
|
}
|
else//¼Ä´æÆ÷µØÖ·³¬³ö·¶Î§
|
{
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1]|0x80;
|
RS485_TX_BUFF[2]=0x02; //Òì³£Âë
|
UART_PushFrame(RS485_TX_BUFF,3);
|
}
|
}
|
|
//Modbus¹¦ÄÜÂë15´¦Àí³ÌÐò //////////////////////////////////////////////////////³ÌÐòÒÑÑéÖ¤OK
|
//д¶à¸öÊä³ö¿ª¹ØÁ¿
|
void Modbus_15_Solve(void)
|
{
|
u16 i;
|
RegNum=(((u16)RS485_RX_BUFF[4])<<8)|RS485_RX_BUFF[5];//»ñÈ¡¼Ä´æÆ÷ÊýÁ¿
|
if((startRegAddr+RegNum)<100)//¼Ä´æÆ÷µØÖ·+ÊýÁ¿ÔÚ·¶Î§ÄÚ
|
{
|
for(i=0; i<RegNum; i++)
|
{
|
if(RS485_RX_BUFF[7+i/8]&0x01) *Modbus_OutputIO[startRegAddr+i]=0x01;
|
else *Modbus_OutputIO[startRegAddr+i]=0x00;
|
RS485_RX_BUFF[7+i/8]>>=1;//´ÓµÍλ¿ªÊ¼
|
}
|
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1];
|
RS485_TX_BUFF[2]=RS485_RX_BUFF[2];
|
RS485_TX_BUFF[3]=RS485_RX_BUFF[3];
|
RS485_TX_BUFF[4]=RS485_RX_BUFF[4];
|
RS485_TX_BUFF[5]=RS485_RX_BUFF[5];
|
calCRC=CRC_Compute(RS485_TX_BUFF,6);
|
RS485_TX_BUFF[6]=(calCRC>>8)&0xFF;
|
RS485_TX_BUFF[7]=(calCRC)&0xFF;
|
UART_PushFrame(RS485_TX_BUFF,8);
|
}
|
else//¼Ä´æÆ÷µØÖ·+ÊýÁ¿³¬³ö·¶Î§
|
{
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1]|0x80;
|
RS485_TX_BUFF[2]=0x02; //Òì³£Âë
|
UART_PushFrame(RS485_TX_BUFF,3);
|
}
|
}
|
|
//Modbus¹¦ÄÜÂë03´¦Àí³ÌÐò///////////////////////////////////////////////////////////////////////////////////////ÒÑÑéÖ¤³ÌÐòOK
|
//¶Á±£³Ö¼Ä´æÆ÷
|
void Modbus_03_Solve(void)
|
{
|
u8 i;
|
RegNum= (((u16)RS485_RX_BUFF[4])<<8)|RS485_RX_BUFF[5];//»ñÈ¡¼Ä´æÆ÷ÊýÁ¿
|
if((startRegAddr+RegNum)<MODBUS_SIZE)//¼Ä´æÆ÷µØÖ·+ÊýÁ¿ÔÚ·¶Î§ÄÚ
|
{
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1];
|
RS485_TX_BUFF[2]=RegNum*2;
|
for(i=0; i<RegNum; i++)
|
{
|
RS485_TX_BUFF[3+i*2]=(Modbus_HoldReg[startRegAddr+i]>>8)&0xFF;// /////////ÏÈ·¢Ë͸ß×Ö½Ú--ÔÚ·¢Ë͵Í×Ö½Ú
|
RS485_TX_BUFF[4+i*2]=(Modbus_HoldReg[startRegAddr+i])&0xFF; //
|
}
|
calCRC=CRC_Compute(RS485_TX_BUFF,RegNum*2+3);
|
RS485_TX_BUFF[RegNum*2+3]=(calCRC>>8)&0xFF; //CRC¸ßµØλ²»¶ÔÂ𣿠// ÏȸߺóµÍ
|
RS485_TX_BUFF[RegNum*2+4]=(calCRC)&0xFF;
|
UART_PushFrame(RS485_TX_BUFF,RegNum*2+5);
|
}
|
else//¼Ä´æÆ÷µØÖ·+ÊýÁ¿³¬³ö·¶Î§
|
{
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1]|0x80;
|
RS485_TX_BUFF[2]=0x02; //Òì³£Âë
|
UART_PushFrame(RS485_TX_BUFF,3);
|
}
|
}
|
|
|
//Modbus¹¦ÄÜÂë06´¦Àí³ÌÐò //////////////////////////////////////////////////////////////////////////////////ÒÑÑéÖ¤³ÌÐòOK
|
//дµ¥¸ö±£³Ö¼Ä´æÆ÷
|
void Modbus_06_Solve(void)
|
{
|
Modbus_HoldReg[startRegAddr]=RS485_RX_BUFF[4]<<8;//¸ß×Ö½ÚÔÚÇ° ////////ÐÞ¸ÄΪ¸ß×Ö½ÚÔÚÇ°£¬µÍ×Ö½ÚÔÚºó
|
Modbus_HoldReg[startRegAddr]|=((u16)RS485_RX_BUFF[5]);//µÍ×Ö½ÚÔÚºó
|
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1];
|
RS485_TX_BUFF[2]=RS485_RX_BUFF[2];
|
RS485_TX_BUFF[3]=RS485_RX_BUFF[3];
|
RS485_TX_BUFF[4]=RS485_RX_BUFF[4];
|
RS485_TX_BUFF[5]=RS485_RX_BUFF[5];
|
|
calCRC=CRC_Compute(RS485_TX_BUFF,6);
|
RS485_TX_BUFF[6]=(calCRC>>8)&0xFF;
|
RS485_TX_BUFF[7]=(calCRC)&0xFF;
|
UART_PushFrame(RS485_TX_BUFF,8);
|
}
|
|
//Modbus¹¦ÄÜÂë16´¦Àí³ÌÐò /////////////////////////////////////////////////////////////////////////////////////////////////ÒÑÑéÖ¤³ÌÐòOK
|
//д¶à¸ö±£³Ö¼Ä´æÆ÷
|
void Modbus_16_Solve(void)
|
{
|
u8 i;
|
RegNum= (((u16)RS485_RX_BUFF[4])<<8)|((RS485_RX_BUFF[5]));//»ñÈ¡¼Ä´æÆ÷ÊýÁ¿
|
if((startRegAddr+RegNum)<MODBUS_SIZE)//¼Ä´æÆ÷µØÖ·+ÊýÁ¿ÔÚ·¶Î§ÄÚ
|
{
|
for(i=0; i<RegNum; i++)
|
{
|
Modbus_HoldReg[startRegAddr+i]=RS485_RX_BUFF[7+i*2]; //µÍ×Ö½ÚÔÚÇ° /////// µÍ×Ö½ÚÔÚÇ°£¬¸ß×Ö½ÚÔÚºóÕý³£
|
Modbus_HoldReg[startRegAddr+i]|=((u16)RS485_RX_BUFF[8+i*2])<<8; //¸ß×Ö½ÚÔÚºó
|
}
|
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1];
|
RS485_TX_BUFF[2]=RS485_RX_BUFF[2];
|
RS485_TX_BUFF[3]=RS485_RX_BUFF[3];
|
RS485_TX_BUFF[4]=RS485_RX_BUFF[4];
|
RS485_TX_BUFF[5]=RS485_RX_BUFF[5];
|
|
calCRC=CRC_Compute(RS485_TX_BUFF,6);
|
RS485_TX_BUFF[6]=(calCRC>>8)&0xFF;
|
RS485_TX_BUFF[7]=(calCRC)&0xFF;
|
UART_PushFrame(RS485_TX_BUFF,8);
|
}
|
else//¼Ä´æÆ÷µØÖ·+ÊýÁ¿³¬³ö·¶Î§
|
{
|
RS485_TX_BUFF[0]=RS485_RX_BUFF[0];
|
RS485_TX_BUFF[1]=RS485_RX_BUFF[1]|0x80;
|
RS485_TX_BUFF[2]=0x02; //Òì³£Âë
|
UART_PushFrame(RS485_TX_BUFF,3);
|
}
|
}
|
