chenxin/SM-1000M
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

20260324

Browse Source
This commit is contained in:
chenxin
2026-04-23 10:50:18 +08:00
commit a436fda935
844 changed files with 272643 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

730
RTX5_20220316/Driver/sdi12/sdi12.c Normal file
View File

@ -0,0 +1,730 @@
#include "sdi12.h"
#include "bsp.h"
u8 test = 0;
Sdi_Fram_Record_Struct Sdi_Fram_Record_Structs;
/***********************/
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƣ<EFBFBD> Diable_Usart3_TX(void)
//<2F><><EFBFBD>ܸ<EFBFBD>λ<EFBFBD><CEBB><EFBFBD>ڣ<EFBFBD>PB10<31><30>Ϊ<EFBFBD><CEAA>ͨIO<49><4F>ʹ<EFBFBD><CAB9>
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><>
void Diable_Usart1_SDI(void)
{
GPIO_InitTypeDef GPIO_InitStructure;
USART_DeInit(USART1); //<2F><>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>1
RCC_AHBPeriphClockCmd(RCC_AHBPeriph_GPIOB, ENABLE); //GPIOBʱ<42><CAB1>
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6 | GPIO_Pin_7;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_10MHz;
GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;
GPIO_Init(GPIOB, &GPIO_InitStructure);
GPIO_ResetBits(GPIOB,GPIO_Pin_6);
//GPIO_SetBits(GPIOB,GPIO_Pin_7);
}
void sdi12_Power_init(void)
{
GPIO_InitTypeDef GPIO_InitStructure;
RCC_AHBPeriphClockCmd(RCC_AHBPeriph_GPIOC, ENABLE); //GPIOCʱ<43><CAB1>
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1 | GPIO_Pin_2 | GPIO_Pin_3;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_10MHz;
GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;
GPIO_Init(GPIOC,&GPIO_InitStructure);
GPIO_ResetBits(GPIOC,GPIO_Pin_1);
GPIO_ResetBits(GPIOC,GPIO_Pin_2);
GPIO_ResetBits(GPIOC,GPIO_Pin_3);
}
/***********************/
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƣ<EFBFBD> sdi12_power_on()
//<2F><><EFBFBD><EFBFBD> <09><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ģ<EFBFBD><C4A3><EFBFBD><EFBFBD>Դ
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ch--<2D><>1--6<><36>
static void sdi12_power_on( uint8_t ch)
{
switch(ch)
{
case 1:
GPIO_ResetBits(GPIOC,GPIO_Pin_3);
GPIO_ResetBits(GPIOC,GPIO_Pin_2);
GPIO_ResetBits(GPIOC,GPIO_Pin_1);
break;
case 2:
GPIO_ResetBits(GPIOC,GPIO_Pin_3);
GPIO_ResetBits(GPIOC,GPIO_Pin_2);
GPIO_SetBits(GPIOC,GPIO_Pin_1);
break;
case 3:
GPIO_ResetBits(GPIOC,GPIO_Pin_3);
GPIO_SetBits(GPIOC,GPIO_Pin_2);
GPIO_ResetBits(GPIOC,GPIO_Pin_1);
break;
case 4:
GPIO_ResetBits(GPIOC,GPIO_Pin_3);
GPIO_SetBits(GPIOC,GPIO_Pin_2);
GPIO_SetBits(GPIOC,GPIO_Pin_1);
break;
case 5:
GPIO_SetBits(GPIOC,GPIO_Pin_3);
GPIO_ResetBits(GPIOC,GPIO_Pin_2);
GPIO_ResetBits(GPIOC,GPIO_Pin_1);
break;
case 6:
GPIO_SetBits(GPIOC,GPIO_Pin_3);
GPIO_ResetBits(GPIOC,GPIO_Pin_2);
GPIO_SetBits(GPIOC,GPIO_Pin_1);
break;
default:
GPIO_SetBits(GPIOC,GPIO_Pin_3);
GPIO_SetBits(GPIOC,GPIO_Pin_2);
GPIO_SetBits(GPIOC,GPIO_Pin_1);
break;
}
}
/***********************/
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƣ<EFBFBD> Enable_Usart3_TX(void)
//<2F><><EFBFBD><EFBFBD> <09><><EFBFBD><EFBFBD>ʼ<EFBFBD><CABC><EFBFBD><EFBFBD><EFBFBD><EFBFBD>3
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> baund,<2C><><EFBFBD>ڲ<EFBFBD><DAB2><EFBFBD><EFBFBD><EFBFBD>
void Enable_Usart1_SDI(void)
{
USART1_SDI_Configuration(1200);
}
/***********************/
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƣ<EFBFBD> Break_Sdi_Sensor(void)
//<2F><><EFBFBD><EFBFBD> <09><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>break<61><6B><EFBFBD><EFBFBD>
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><>
void Break_Sdi_Sensor(void)
{
Enable_SdiTX;
GPIO_ResetBits(GPIOB,GPIO_Pin_6);//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
delay_ms(20);
GPIO_SetBits(GPIOB,GPIO_Pin_6);
}
void Sdi_StartMeasure(void)
{
u8 i=0;
char temp_sdi[5]={'\0'};
USART1_SDI_CLR_RXBuf();
for(i=1;i<7;i++)
{
delay_ms(500);
memset(temp_sdi,0,5);
sprintf(temp_sdi,"%d%s",0,"M!");
Diable_Usart1_SDI();
Break_Sdi_Sensor();// <20><><EFBFBD>Ϳպźʹ<C5BA><CDB4><EFBFBD>
Enable_Usart1_SDI();
u1_printf("%s",temp_sdi);
delay_ms(10);
Enable_SdiRX;
delay_ms(600);
USART1_SDI_CLR_RXBuf();//<2F><>ȡ<EFBFBD><C8A1><EFBFBD>ݲ<EFBFBD><DDB2>ִ<EFBFBD><D6B4><EFBFBD>
memset(temp_sdi,0,5);
sprintf(temp_sdi,"%d%s",0,"D0!");
USART1_SDI_CLR_RXBuf();
Diable_Usart1_SDI();
Break_Sdi_Sensor();// <20><><EFBFBD>Ϳպźʹ<C5BA><CDB4><EFBFBD>
Enable_Usart1_SDI();
u1_printf("%s",temp_sdi);
delay_ms(10);
Enable_SdiRX;
delay_ms(600);
Sdi_Par(i);
}
/*
Diable_Usart1_SDI();
Break_Sdi_Sensor();// <20><><EFBFBD>Ϳպźʹ<C5BA><CDB4><EFBFBD>
Enable_Usart1_SDI();
u1_printf("0M!");
delay_ms(8);
Enable_SdiRX;
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
*/
}
char Sdi_readaddress(void)
{
char *str;
osMutexAcquire(SDI_MutexID,osWaitForever);
sdi12_power_on(1);
USART_RS232_DEinit();
Enable_SDI_RS232=0;
Diable_Usart1_SDI();
USART1_SDI_CLR_RXBuf();
Break_Sdi_Sensor();// <20><><EFBFBD>Ϳպźʹ<C5BA><CDB4><EFBFBD>
Enable_Usart1_SDI();
u1_printf("%s","?!");
delay_ms(8);
Enable_SdiRX;
delay_ms(500);
osMutexRelease(SDI_MutexID);
if((str=strstr(USART1_SDI_RX_BUF,"\r\n")) !=NULL)
{
str--;
return str[0];
}
return 0x7f;
}
void Sdi_chanegadd(char a,char b)
{
char tempadd_sdi[10]={'\0'};
sdi12_power_on(1);
//a=3;
//b=0;
//osMutexAcquire(SDI_MutexID,osWaitForever);
//sprintf(tempadd_sdi,"%c%c%c%c",a,'A',b,'!');
sprintf(tempadd_sdi,"%s","3A0!");
USART_RS232_DEinit();
Enable_SDI_RS232=0;
Diable_Usart1_SDI();
USART1_SDI_CLR_RXBuf();
Break_Sdi_Sensor();// <20><><EFBFBD>Ϳպźʹ<C5BA><CDB4><EFBFBD>
Enable_Usart1_SDI();
u1_printf("%s",tempadd_sdi);
delay_ms(8);
Enable_SdiRX;
delay_ms(500);
//osMutexRelease(SDI_MutexID);
}
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>,<2C>ж<EFBFBD><D0B6>Ƿ<EFBFBD><C7B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ݷ<EFBFBD><DDB7><EFBFBD>
u8 Sdi_Readone(char add)
{
char temp_sdi[5]={'\0'};
char *subStringP;
char *subStringN;
USART1_SDI_CLR_RXBuf();
memset(temp_sdi,0,5);
sprintf(temp_sdi,"%c%s",add,"D0!");
USART1_SDI_CLR_RXBuf();
Diable_Usart1_SDI();
Break_Sdi_Sensor();// <20><><EFBFBD>Ϳպźʹ<C5BA><CDB4><EFBFBD>
Enable_Usart1_SDI();
u1_printf("%s",temp_sdi);
delay_ms(8);
Enable_SdiRX;
delay_ms(500);
subStringP=strstr(USART1_SDI_RX_BUF,"+");
subStringN=strstr(USART1_SDI_RX_BUF,"-");
if((subStringP!=NULL)|(subStringN!=NULL))
return 0;
else return 1;
}
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
//void Sdi_Read(void)
//{
// u8 i=0;
// char temp_sdi[5]={'\0'};
//
// for(i=1;i<7;i++)
// {
// USART1_SDI_CLR_RXBuf();
// memset(temp_sdi,0,5);
// sprintf(temp_sdi,"%d%s",i,"D0!");
// USART1_SDI_CLR_RXBuf();
// Diable_Usart1_SDI();
// Break_Sdi_Sensor();// <20><><EFBFBD>Ϳպźʹ<C5BA><CDB4><EFBFBD>
// Enable_Usart1_SDI();
// u1_printf("%s",temp_sdi);
// delay_ms(8);
// Enable_SdiRX;
// delay_ms(500);
// Sdi_Par(0);
// }
//}
////<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
//void Sdi_Read(void)
//{
// u8 i=0;
// char temp_sdi[5]={'\0'};
//
// for(i=1;i<10;i++)
// {
// USART1_SDI_CLR_RXBuf();
// memset(temp_sdi,0,5);
// sprintf(temp_sdi,"%d%s",i,"D0!");
// USART1_SDI_CLR_RXBuf();
// Diable_Usart1_SDI();
// Break_Sdi_Sensor();// <20><><EFBFBD>Ϳպźʹ<C5BA><CDB4><EFBFBD>
// Enable_Usart1_SDI();
// u1_printf("%s",temp_sdi);
// delay_ms(8);
// Enable_SdiRX;
// delay_ms(500);
// Sdi_Par(i);
//
// }
//}
uint16_t usMBCRC16( unsigned char * pucFrame, uint16_t usLen )
{
static const uint16_t aucCRCHi[] =
{
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
};
static const uint16_t aucCRCLo[] =
{
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
};
uint16_t ucCRCHi = 0xFF;
uint16_t ucCRCLo = 0xFF;
int iIndex;
while( usLen-- )
{
iIndex = ucCRCLo ^ *( pucFrame++ );
ucCRCLo = ( uint16_t )( ucCRCHi ^ aucCRCHi[iIndex] );
ucCRCHi = aucCRCLo[iIndex];
}
return ( uint16_t )( ucCRCHi << 8 | ucCRCLo );
}
float hex_to_flota(char data[])
{
float *p = (float*)data;
return *p;
}
//<2F><><EFBFBD><EFBFBD>SDI<44><49><EFBFBD><EFBFBD>
void Sdi_Par(u8 add)
{
char *subStringP;
char *subStringN;
char *subString;
char *subStringNext;
char pos1_data[10],pos2_data[10],pos3_data[10],Temp[3] = {'\0'};
uint16_t CRC_DATA= 0;
float SDI_T = 0,SDI_H = 0,SDI_P =0;
int16_t inttofloat = 0;
Sdi_Fram_Record_Structs.Flag_finish_DATA=0;
CRC_DATA = usMBCRC16(Usart5_Fram_Record_Structs .Usart5_RX_BUF,9);
if(((CRC_DATA&0x00ff) == Usart5_Fram_Record_Structs .Usart5_RX_BUF[9]) && (((CRC_DATA >> 8)&0x00ff) == Usart5_Fram_Record_Structs .Usart5_RX_BUF[10]))
{
memset(pos1_data,0,10);
memset(pos2_data,0,10);
memset(pos3_data,0,10);
/***********<2A>ж<EFBFBD><D0B6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ġ<EFBFBD>*************/
inttofloat = Usart5_Fram_Record_Structs .Usart5_RX_BUF[3];
inttofloat = (inttofloat << 8) + Usart5_Fram_Record_Structs .Usart5_RX_BUF[4];
SDI_T = inttofloat*1.0/10;
// inttofloat = SDI_T*100;
// if((inttofloat % 10) == 0)
// {
// SDI_T = SDI_T + 0.01;
// }
sprintf(pos3_data,"%.1f",SDI_T);
inttofloat = Usart5_Fram_Record_Structs .Usart5_RX_BUF[5];
inttofloat = (inttofloat << 8) + Usart5_Fram_Record_Structs .Usart5_RX_BUF[6];
SDI_H = inttofloat*1.0/10;
// inttofloat = SDI_H*100;
// if((inttofloat % 10) == 9)
// {
// SDI_H = SDI_H + 0.01;
// }
sprintf(pos1_data,"%.1f",SDI_H);
inttofloat = Usart5_Fram_Record_Structs .Usart5_RX_BUF[7];
inttofloat = (inttofloat << 8) + Usart5_Fram_Record_Structs .Usart5_RX_BUF[8];
SDI_P = inttofloat;
sprintf(pos2_data,"%.0f",SDI_P);
switch (add)
{
case 1: sprintf(Sdi_Fram_Record_Structs.Ch1_RX_BUF, "%s,%s,%s", pos3_data,pos1_data,pos2_data);break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>0<EFBFBD><30><EFBFBD><EFBFBD>
case 2: sprintf(Sdi_Fram_Record_Structs.Ch2_RX_BUF, "%s,%s,%s", pos3_data,pos1_data,pos2_data);break;//<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>1<EFBFBD><31><EFBFBD><EFBFBD>
case 3: sprintf(Sdi_Fram_Record_Structs.Ch3_RX_BUF, "%s,%s,%s", pos3_data,pos1_data,pos2_data);break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>2<EFBFBD><32><EFBFBD><EFBFBD>
case 4: sprintf(Sdi_Fram_Record_Structs.Ch4_RX_BUF, "%s,%s,%s", pos3_data,pos1_data,pos2_data);break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>3<EFBFBD><33><EFBFBD><EFBFBD>
case 5: sprintf(Sdi_Fram_Record_Structs.Ch5_RX_BUF, "%s,%s,%s", pos3_data,pos1_data,pos2_data);break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>4<EFBFBD><34><EFBFBD><EFBFBD>
case 6: sprintf(Sdi_Fram_Record_Structs.Ch6_RX_BUF, "%s,%s,%s", pos3_data,pos1_data,pos2_data);break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>5<EFBFBD><35><EFBFBD><EFBFBD>
// case 7: sprintf(Sdi_Fram_Record_Structs.Ch7_RX_BUF, "%s,%s,%s", pos1_data,pos2_data,pos3_data);break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>6<EFBFBD><36><EFBFBD><EFBFBD>
// case 8: sprintf(Sdi_Fram_Record_Structs.Ch8_RX_BUF, "%s,%s,%s", pos1_data,pos2_data,pos3_data);break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>7<EFBFBD><37><EFBFBD><EFBFBD>
// case 9: sprintf(Sdi_Fram_Record_Structs.Ch9_RX_BUF, "%s,%s,%s", pos1_data,pos2_data,pos3_data);break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>8<EFBFBD><38><EFBFBD><EFBFBD>
default:break;
}
Sdi_Fram_Record_Structs.Flag_finish_DATA=1;
}
else
{
switch (add)
{
case 1: sprintf(Sdi_Fram_Record_Structs.Ch1_RX_BUF, "Na,Na,Na" );break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>0<EFBFBD><30><EFBFBD><EFBFBD>
case 2: sprintf(Sdi_Fram_Record_Structs.Ch2_RX_BUF, "Na,Na,Na");break;//<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>1<EFBFBD><31><EFBFBD><EFBFBD>
case 3: sprintf(Sdi_Fram_Record_Structs.Ch3_RX_BUF, "Na,Na,Na");break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>2<EFBFBD><32><EFBFBD><EFBFBD>
case 4: sprintf(Sdi_Fram_Record_Structs.Ch4_RX_BUF, "Na,Na,Na");break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>3<EFBFBD><33><EFBFBD><EFBFBD>
case 5: sprintf(Sdi_Fram_Record_Structs.Ch5_RX_BUF, "Na,Na,Na");break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>4<EFBFBD><34><EFBFBD><EFBFBD>
case 6: sprintf(Sdi_Fram_Record_Structs.Ch6_RX_BUF, "Na,Na,Na");break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>5<EFBFBD><35><EFBFBD><EFBFBD>
// case 7: sprintf(Sdi_Fram_Record_Structs.Ch7_RX_BUF, "Na,Na,Na");break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>6<EFBFBD><36><EFBFBD><EFBFBD>
// case 8: sprintf(Sdi_Fram_Record_Structs.Ch8_RX_BUF, "Na,Na,Na");break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>7<EFBFBD><37><EFBFBD><EFBFBD>
// case 9: sprintf(Sdi_Fram_Record_Structs.Ch9_RX_BUF, "Na,Na,Na");break; //<2F><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>8<EFBFBD><38><EFBFBD><EFBFBD>
default:break;
}
}
}
void sdi12_buf_clear(void)
{
memset(Sdi_Fram_Record_Structs.Ch1_RX_BUF,0,sizeof(Sdi_Fram_Record_Structs.Ch1_RX_BUF));
memset(Sdi_Fram_Record_Structs.Ch2_RX_BUF,0,sizeof(Sdi_Fram_Record_Structs.Ch2_RX_BUF));
memset(Sdi_Fram_Record_Structs.Ch3_RX_BUF,0,sizeof(Sdi_Fram_Record_Structs.Ch3_RX_BUF));
memset(Sdi_Fram_Record_Structs.Ch4_RX_BUF,0,sizeof(Sdi_Fram_Record_Structs.Ch4_RX_BUF));
memset(Sdi_Fram_Record_Structs.Ch5_RX_BUF,0,sizeof(Sdi_Fram_Record_Structs.Ch5_RX_BUF));
memset(Sdi_Fram_Record_Structs.Ch6_RX_BUF,0,sizeof(Sdi_Fram_Record_Structs.Ch6_RX_BUF));
// memset(Sdi_Fram_Record_Structs.Ch7_RX_BUF,0,sizeof(Sdi_Fram_Record_Structs.Ch7_RX_BUF));
// memset(Sdi_Fram_Record_Structs.Ch8_RX_BUF,0,sizeof(Sdi_Fram_Record_Structs.Ch8_RX_BUF));
// memset(Sdi_Fram_Record_Structs.Ch9_RX_BUF,0,sizeof(Sdi_Fram_Record_Structs.Ch9_RX_BUF));
memset(Sdi_Fram_Record_Structs.QXZ_RX_BUF,0,sizeof(Sdi_Fram_Record_Structs.QXZ_RX_BUF));
}
void ChangeRs485Addr( char addr)
{
unsigned char i= 0,NUM = 0, CMD[10] = {'\0'};
uint16_t CRC_Data;
memset(Usart5_Fram_Record_Structs .Usart5_RX_BUF,0,sizeof(Usart5_Fram_Record_Structs .Usart5_RX_BUF));
RS485_TX_EN;
delay_ms(10);
CMD[i++] = 0xfe;
CMD[i++] = 0x06;
CMD[i++] = 0x00;
CMD[i++] = 0x30;
CMD[i++] = 0x00;
CMD[i++] = 0x02;
CRC_Data = usMBCRC16(CMD,6);
CMD[i++] = CRC_Data&0x00ff;
CMD[i++] = (CRC_Data>>8)&0x00ff;
for(NUM = 0; NUM < 8; NUM++)
{
while(USART_GetFlagStatus(UART5,USART_FLAG_TC)==RESET); //ѭ<><D1AD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>,ֱ<><D6B1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
USART_SendData(UART5,CMD[NUM]);
}
delay_ms(10);
RS485_RX_EN;
delay_ms(1000);
RS485_TX_EN;
delay_ms(10);
i = 0;
CMD[i++] = Usart5_Fram_Record_Structs .Usart5_RX_BUF[0];
CMD[i++] = 0x06;
CMD[i++] = 0x00;
CMD[i++] = 0x30;
CMD[i++] = 0x00;
CMD[i++] = addr;
CRC_Data = usMBCRC16(CMD,6);
CMD[i++] = CRC_Data&0x00ff;
CMD[i++] = (CRC_Data>>8)&0x00ff;
for(NUM = 0; NUM < 8; NUM++)
{
while(USART_GetFlagStatus(UART5,USART_FLAG_TC)==RESET); //ѭ<><D1AD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>,ֱ<><D6B1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
USART_SendData(UART5,CMD[NUM]);
}
delay_ms(10);
RS485_RX_EN;
delay_ms(1000);
__nop();
}
void Get_Sdi_Data(uint8_t Addr_485)
{
uint16_t CRC_Data;
unsigned char i= 0,NUM = 0, CMD[10] = {'\0'};
Usart5_Fram_Record_Structs .InfBit .FramLength = 0;
memset(Usart5_Fram_Record_Structs .Usart5_RX_BUF,0,sizeof(Usart5_Fram_Record_Structs .Usart5_RX_BUF));
RS485_TX_EN;
delay_ms(10);
CMD[i++] = Addr_485;
CMD[i++] = 0x03;
CMD[i++] = 0x00;
CMD[i++] = 0x00;
CMD[i++] = 0x00;
CMD[i++] = 0x03;
CRC_Data = usMBCRC16(CMD,6);
CMD[i++] = CRC_Data&0x00ff;
CMD[i++] = (CRC_Data>>8)&0x00ff;
for(NUM = 0; NUM < 8; NUM++)
{
while(USART_GetFlagStatus(UART5,USART_FLAG_TC)==RESET); //ѭ<><D1AD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>,ֱ<><D6B1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
USART_SendData(UART5,CMD[NUM]);
}
delay_ms(10);
RS485_RX_EN;
delay_ms(1000);
__nop();
}
// <20><><EFBFBD><EFBFBD> MODBUS <20><><EFBFBD>س<EFBFBD><D8B3><EFBFBD>
#define MODBUS_SLAVE_ADDR 0x01 // <20>ӻ<EFBFBD><D3BB><EFBFBD>ַ
#define MODBUS_FUNC_CODE 0x04 // <20><><EFBFBD><EFBFBD><EFBFBD>루<EFBFBD><EBA3A8>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD>Ĵ<EFBFBD><C4B4><EFBFBD><EFBFBD><EFBFBD>
#define MODBUS_START_ADDR 0x0000 // <20><>ʼ<EFBFBD><CABC>ַ
#define MODBUS_NUM_REGISTERS 0x0E // <20>Ĵ<EFBFBD><C4B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
// CRC16 <20><><EFBFBD>㺯<EFBFBD><E3BAAF>
uint16_t MODBUS_CRC16(uint8_t *data, uint16_t len) {
uint16_t crc = 0xFFFF;
for (uint16_t i = 0; i < len; i++) {
crc ^= data[i];
for (uint8_t j = 0; j < 8; j++) {
if (crc & 0x0001) {
crc >>= 1;
crc ^= 0xA001;
} else {
crc >>= 1;
}
}
}
return crc;
}
// <20><><EFBFBD><EFBFBD> MODBUS <20><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD>
void MODBUS_SendReadRequest(uint8_t slaveAddr, uint16_t startAddr, uint16_t numRegisters) {
uint16_t CRC_Data;
//uint8_t request[8];
unsigned char i = 0, NUM = 0, request[10] = {'\0'};
Usart5_Fram_Record_Structs .InfBit .FramLength = 0;
memset(Usart5_Fram_Record_Structs .Usart5_RX_BUF,0,sizeof(Usart5_Fram_Record_Structs .Usart5_RX_BUF));
// <20>л<EFBFBD><D0BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ģʽ
RS485_TX_EN; // <20><><EFBFBD><EFBFBD><EFBFBD>շ<EFBFBD><D5B7><EFBFBD><EFBFBD><EFBFBD>Ϊ<EFBFBD><CEAA><EFBFBD><EFBFBD>ģʽ
delay_ms(10); // <20>ȴ<EFBFBD><C8B4>ȶ<EFBFBD>
request[i++] = slaveAddr; // <20>ӻ<EFBFBD><D3BB><EFBFBD>ַ
request[i++] = MODBUS_FUNC_CODE; // <20><><EFBFBD><EFBFBD><EFBFBD>루<EFBFBD><EBA3A8>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD>Ĵ<EFBFBD><C4B4><EFBFBD><EFBFBD><EFBFBD>
request[i++] = (startAddr >> 8) & 0xFF; // <20><>ʼ<EFBFBD><CABC>ַ<EFBFBD><D6B7><EFBFBD>ֽ<EFBFBD>
request[i++] = startAddr & 0xFF; // <20><>ʼ<EFBFBD><CABC>ַ<EFBFBD><D6B7><EFBFBD>ֽ<EFBFBD>
request[i++] = (numRegisters >> 8) & 0xFF; // <20>Ĵ<EFBFBD><C4B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֽ<EFBFBD>
request[i++] = numRegisters & 0xFF; // <20>Ĵ<EFBFBD><C4B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֽ<EFBFBD>
// <20><><EFBFBD><EFBFBD> CRC
CRC_Data = MODBUS_CRC16(request, 6);
request[i++] = CRC_Data & 0x00FF; // CRC <20><><EFBFBD>ֽ<EFBFBD>
request[i++] = (CRC_Data >> 8) & 0x00FF; // CRC <20><><EFBFBD>ֽ<EFBFBD>
// // <20><>ӡ<EFBFBD><D3A1><EFBFBD>͵<EFBFBD><CDB5><EFBFBD><EFBFBD><EFBFBD>
// u5_printf("Sending MODBUS request: ");
// for (uint8_t i = 0; i < 8; i++) {
// u5_printf("%02X ", request[i]);
// }
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
for (NUM = 0; NUM < 8; NUM++) {
while (USART_GetFlagStatus(UART5, USART_FLAG_TC) == RESET); // <20>ȴ<EFBFBD><C8B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
USART_SendData(UART5, request[NUM]);
}
while (USART_GetFlagStatus(UART5, USART_FLAG_TC) == RESET);
//u5_printf("\n");
// <20>л<EFBFBD><D0BB>ؽ<EFBFBD><D8BD><EFBFBD>ģʽ
//delay_ms(10);
RS485_RX_EN;
//delay_ms(1000);
__nop();
}
// <20><><EFBFBD><EFBFBD> MODBUS <20><>Ӧ
int MODBUS_ParseResponse(uint8_t *response, uint16_t len, SensorData *output) {
//
// // // <20><>ӡԭʼ<D4AD><CABC>Ӧ<EFBFBD><D3A6><EFBFBD><EFBFBD>
// u5_printf("Response Data: ");
// for (uint16_t i = 0; i < len; i++) {
// u5_printf("%02X ", response[i]);
// }
// u5_printf("\n");
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʼ<EFBFBD><CABC>־λ
if (response[0] != MODBUS_SLAVE_ADDR) { // <20>ӻ<EFBFBD><D3BB><EFBFBD>ַΪ 0x01
return -4;
}
// У<><D0A3> CRC
uint16_t crc = MODBUS_CRC16(response, len - 2);
if ((response[len - 2] != (crc & 0xFF)) || (response[len - 1] != ((crc >> 8) & 0xFF))) {
//u5_printf("CRC Error: Expected %04X, Got %02X%02X\n", crc, response[len - 1], response[len - 2]);
return -1;
}
// <20><><EFBFBD>鹦<EFBFBD><E9B9A6><EFBFBD><EFBFBD>
if (response[1] != MODBUS_FUNC_CODE) {
return -2;
}
// <20><>ȡ<EFBFBD><C8A1><EFBFBD>ݳ<EFBFBD><DDB3><EFBFBD>
uint8_t dataLen = response[2];
if (dataLen % 4 != 0) {
return -3;
}
// <20><><EFBFBD>ֽ<EFBFBD><D6BD><EFBFBD><EFBFBD><EFBFBD>ת<EFBFBD><D7AA>Ϊ<EFBFBD><CEAA><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
for (uint8_t i = 0; i < dataLen; i += 4) {
uint32_t temp = ((uint32_t)response[3 + i] << 24) |
((uint32_t)response[4 + i] << 16) |
((uint32_t)response[5 + i] << 8) |
(uint32_t)response[6 + i];
float value = *((float *)&temp);
// <20>ֶδ<D6B6>ӡ
int integerPart = (int)value;
int decimalPart = (int)((value - integerPart) * 1000); // <20><><EFBFBD><EFBFBD> 3 λС<CEBB><D0A1>
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>С<EFBFBD><D0A1><EFBFBD>ֱ<EFBFBD><D6B1>洢<EFBFBD><E6B4A2><EFBFBD>ṹ<EFBFBD><E1B9B9>
output[i / 4].integerPart = integerPart;
output[i / 4].decimalPart = decimalPart;
//u5_printf("Integer: %d, Decimal: %03d\n", integerPart, decimalPart);
}
return 0; // <20><><EFBFBD><EFBFBD><EFBFBD>ɹ<EFBFBD>
}
// <20><>ȡ MODBUS <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
void Get_MODBUS_SensorData(void) {
uint8_t response[256];
uint16_t len = 0;
SensorData sensorData[7]; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> 7 <20><><EFBFBD><EFBFBD><EFBFBD>ݣ<EFBFBD><DDA3>¶ȡ<C2B6>ʪ<EFBFBD>ȡ<EFBFBD>ѹ<EFBFBD><D1B9><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>١<EFBFBD><D9A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>գ<EFBFBD>
// <20><><EFBFBD><EFBFBD> MODBUS <20><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD>
MODBUS_SendReadRequest(MODBUS_SLAVE_ADDR, MODBUS_START_ADDR, MODBUS_NUM_REGISTERS);
// <20>ȴ<EFBFBD><C8B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ӧ
delay_ms(100);
len = Usart5_Fram_Record_Structs.InfBit.FramLength;
memcpy(response, Usart5_Fram_Record_Structs.Usart5_RX_BUF, len);
///////////////////////////////////////////////////////////////////////////////////////////////////////////////
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ӧ
int result = MODBUS_ParseResponse(response, len, sensorData);
if (result != 0) {
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
//sprintf(Sdi_Fram_Record_Structs.Ch1_RX_BUF, "Error: Failed to parse sensor data");
sprintf(Sdi_Fram_Record_Structs.QXZ_RX_BUF, "Na,Na,Na,Na,Na,Na,Na");
return;
}
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ݴ洢<DDB4><E6B4A2> Ch1_RX_BUF
// "qxz-Temperature,qxz-Humidity,qxz-AirPressure,qxz-WindSpeed,qxz-WindDirection,qxz-Rainfall,qxz-Illuminance,"
//
sprintf(Sdi_Fram_Record_Structs.QXZ_RX_BUF,
"%d.%01d,%d.%01d,%d.%01d,%d.%02d,%d,%d,%d",
sensorData[0].integerPart, sensorData[0].decimalPart / 100, // <20><EFBFBD>
sensorData[1].integerPart, sensorData[1].decimalPart / 100, // ʪ<><CAAA>
sensorData[2].integerPart, sensorData[2].decimalPart / 100, // <20><>ѹ
sensorData[3].integerPart, sensorData[3].decimalPart / 10, // <20><><EFBFBD><EFBFBD>
sensorData[4].integerPart, // <20><><EFBFBD><EFBFBD>
sensorData[5].integerPart, // <20><><EFBFBD><EFBFBD>
sensorData[6].integerPart); // <20><><EFBFBD><EFBFBD>
}
void sdi12_process(void)
{
uint8_t ADDR = 1;
delay_ms(500);
PWR_CTRL485_H;
delay_ms(1000);
sdi12_buf_clear();
Get_MODBUS_SensorData();// <20><>ȡ MODBUS <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
// ChangeRs485Addr(1);
for(ADDR = 1; ADDR < 7; ADDR++)
{
//if (ADDR == 1) continue;// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>󴫸<EFBFBD><F3B4ABB8><EFBFBD>
Get_Sdi_Data(ADDR);
Sdi_Par(ADDR);
}
PWR_CTRL485_L;
delay_ms(1000);
//Sdi_StartMeasure();//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
}