¶Ô±ÈÐÂÎļþ |
| | |
| | | #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;//åæ¢ä¸ºå鿍¡å¼ |
| | | delay_us(100); |
| | | 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;//å¼å¯æ¥æ¶æ¨¡å¼ |
| | | delay_us(100); |
| | | } |
| | | |
| | | |
| | | ///////////////////////////////////////////////////////////////////////////////////// |
| | | //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; //å¼å¸¸ç |
| | | RS485_SendData(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; //å¼å¸¸ç |
| | | RS485_SendData(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; //å¼å¸¸ç |
| | | RS485_SendData(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; |
| | | RS485_SendData(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; //å¼å¸¸ç |
| | | RS485_SendData(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; |
| | | RS485_SendData(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; //å¼å¸¸ç |
| | | RS485_SendData(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; |
| | | RS485_SendData(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; //å¼å¸¸ç |
| | | RS485_SendData(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; |
| | | RS485_SendData(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; //å¼å¸¸ç |
| | | RS485_SendData(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; |
| | | RS485_SendData(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; //å¼å¸¸ç |
| | | RS485_SendData(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; |
| | | RS485_SendData(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; |
| | | RS485_SendData(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; //å¼å¸¸ç |
| | | RS485_SendData(RS485_TX_BUFF,3); |
| | | } |
| | | } |
| | | |
| | | |
| | | |
| | | |