国产最新无码专区在线,成人免费国产二区三区视频不卡

/* Includes ------------------------------------------------------------------*/
#include "stm8s_lib.h"
#include "functions.h"
//#include "STM8S103F.h"
#include "stm8s_tim1.h"
/* Private typedef -----------------------------------------------------------*/
/* Private define ------------------------------------------------------------*/
u16 re_CRC16;
u8 CRC_Len;
u8 Data_Len;
u8 OffsetAdr;
u8 SlaveAdr;
u8 ModbusFC;
ModBusData ModbusRAM[ModBusRAM_LEN_MAX];
void Respond_ModbusREQ(void);
void Init_Clock(void);
/*
void Init_GPIO(void);
void Init_GPIO(void)
{
GPIO_Init(GPIOD, GPIO_PIN_6, GPIO_MODE_IN_FL_NO_IT); //UART1 RX
GPIO_Init(GPIOD, GPIO_PIN_5, GPIO_MODE_OUT_PP_HIGH_FAST); //UART1 TX
}
*/
void Init_Clock(void)//
{
/* Select fCPU = 16MHz*/
CLK_DeInit();
CLK_HSICmd(ENABLE);
CLK_HSECmd(DISABLE);
CLK_SYSCLKConfig(CLK_PRESCALER_HSIDIV1);//CLK_PRESCALER_CPUDIV1 16mhz
nop();nop();nop();nop();nop();nop();
//CLK_CCOConfig(CLK_OUTPUT_CPU); /* For test purpose output Fcpu on MCO pin */
}
/******************* (C) COPYRIGHT 2008 STMicroelectronics *****END OF FILE****/
void Respond_ModbusREQ(void)
{
u8 tmpMODBUS[RX_LEN_MAX];
u8 i;
ModbusFC = MODBUS[1];
Data_Len = MODBUS[5];
switch(ModbusFC)
{
case 0x03:
i = 8;
break;
case 0x10:
i = (u8)(9 + (Data_Len * 2));
break;
default:
i = 0;
break;
}
if(i>0)
{
CRC_Len = (u8)(i - 2);
while(i>0)
{
tmpMODBUS[i-1] = MODBUS[i-1];
i--;
}
re_CRC16 = tmpMODBUS[CRC_Len + 1];
re_CRC16 = (re_CRC16<<8)+tmpMODBUS[CRC_Len]; //尋找接收的CRC碼
CRC16 = crc16(tmpMODBUS,CRC_Len); //計算接收數(shù)據(jù)的CRC
if((re_CRC16 == CRC16)&&(OffsetAdr<ModBusRAM_LEN_MAX))//如果校驗正確判斷功能碼和數(shù)據(jù)起始地址
{
OffsetAdr = (u8)((tmpMODBUS[3]) * 2); //OffsetAdr = tmpMODBUS[2] * 256 + tmpMODBUS[3];
Data_Len = (u8)(tmpMODBUS[5] * 2); //讀寫寄存器數(shù)量
switch(ModbusFC)
{
case 0x03: //判斷功能碼響應(yīng)指令發(fā)送被召喚數(shù)據(jù)
{
//if(tmpMODBUS[3] == 0x01)
// {
tmpMODBUS[2] = Data_Len; //字節(jié)數(shù)=寄存器數(shù)量＊2
for(i=0;i<Data_Len;i++)
{
if(i & 0x01)
tmpMODBUS[3 + i] = (u8)(ModbusRAM[((OffsetAdr+i)>>1)].ModBus16Word % 0x100);
else
tmpMODBUS[3 + i] = (u8)(ModbusRAM[((OffsetAdr+i)>>1)].ModBus16Word / 0x100);
}
CRC_Len = (u8)(3 + Data_Len);
CRC16 = crc16(tmpMODBUS,CRC_Len); //計算接收數(shù)據(jù)的CRC
tmpMODBUS[CRC_Len]=(u8)(CRC16); //LSB
tmpMODBUS[CRC_Len+1]=(u8)(CRC16>>8); //MSB
SEND_ON
for(i=0;i<CRC_Len+2;i++) //發(fā)送應(yīng)答數(shù)據(jù) 多寄存器讀命令返回
{
UART1->DR=tmpMODBUS[i];
while (UART1_GetFlagStatus(UART1_FLAG_TXE) == RESET); //
}
while (UART1_GetFlagStatus(UART1_FLAG_TC) == RESET);
SEND_OFF
//}
}
break;
case 0x10: //如果檢測到是多字節(jié)寫入指令
{
/*
FLASH_SetProgrammingTime(FLASH_PROGRAMTIME_STANDARD); //寫EEPROM準(zhǔn)備
FLASH_Unlock(FLASH_MEMTYPE_DATA);
for(i=0;i<Data_Len;i++) //寫EEP
{
FLASH_ProgramByte((EEPROM_Start_Adr + OffsetAdr + i), tmpMODBUS[i + 7]);
}
*/
CRC_Len = 3 + 4; //發(fā)送應(yīng)答數(shù)據(jù)
CRC16 = crc16(tmpMODBUS,CRC_Len); //計算接收數(shù)據(jù)的CRC
tmpMODBUS[CRC_Len]=(u8)(CRC16); //LSB
tmpMODBUS[CRC_Len+1]=(u8)(CRC16>>8); //MSB
SEND_ON
for(i=0;i<CRC_Len+2;i++) //發(fā)送應(yīng)答數(shù)據(jù)
{
UART1->DR = tmpMODBUS[i];
while (UART1_GetFlagStatus(UART1_FLAG_TXE) == RESET);
}
while (UART1_GetFlagStatus(UART1_FLAG_TC) == RESET);
SEND_OFF
}
break;
default:
break;
}
return; //直接退出中斷函數(shù)，不執(zhí)行CT=CT+1;語句
}
else //如果校驗出錯發(fā)送自定義異常代碼 80||03||10，04讀寫指令ERROR
{
//發(fā)送異常代碼
tmpMODBUS[1] |= 0x80; //異常指令 OR
tmpMODBUS[2] = 0x04; //異常代碼
CRC16 = crc16(tmpMODBUS,3); //計算接收數(shù)據(jù)的CRC
tmpMODBUS[3] = (u8)(CRC16); //LSB
tmpMODBUS[4] = (u8)(CRC16>>8); //MSB
SEND_ON
for(CRC16=0;CRC16<5;CRC16++) //發(fā)送應(yīng)答數(shù)據(jù)
{
UART1->DR=tmpMODBUS[CRC16];
while (UART1_GetFlagStatus(UART1_FLAG_TXE) == RESET);
}
while (UART1_GetFlagStatus(UART1_FLAG_TC) == RESET);
SEND_OFF
return;
}
}
}

復(fù)制代碼