przykładowa ramka:
[SOH]10[RS]THO[RS]124F80[RS]42[EOT]
Wiec, napisałem sobie takie 2 funkcję:
1. Funkcja parsujaca odebrane dane:
[syntax=c]volatile TASK ask;
volatile TANS ans;
const TWS whitesigns = { 0x01, 0x1E, 0x04}; // SOH | RS | EOT
int8_t ParseUsartData( char * buf )
{
char * cmd_ptr;//wswkaźnik komendy
char * rest;
uint8_t i=0, len;
if( strpbrk(buf, whitesigns.SOH) )//wyszukanie w buforze [SOH] StartOfHeader
{
cmd_ptr=strtok_r(buf, whitesigns.RS, &rest); //Wyluskanie lancucha z adresem
if( strlen(cmd_ptr) ) return 2;//Sprawdzanie czy lancuch nie jest pusty
ask.adress=atoi(cmd_ptr);//Konwersja cmd_ptr na int i zapis wartosci int do struktury ASK
if( DEVICE_ADDR != ask.adress )//Sprawdzenie czy "moj adres" jesli nie przerwij
{
ask.adress=0;//wyzerowanie odebranego adresu
return 0;//zgloszenie innego adresu
}
cmd_ptr=strtok_r(buf, whitesigns.RS, &rest);//Wyluskanie lancucha z komenda przed [RS]
len = strlen(cmd_ptr);//Wyluskanie dlugosci odebranej komendy
for(i=0; i<NO_CMD; i++)//Porownaie odebranej komendy z komendami w pamięci
{
if( len && 0==strncasecmp(cmd_ptr, tcmd[i].cmd, len) )
{
ask.cmd_id=tcmd[i].id;//Wypełnienie pola cmd struktury ASK
}
}
cmd_ptr=strtok_r(NULL, whitesigns.RS, &rest); //Wyluskanie lancucha z danymi przed [RS]
if( strlen(cmd_ptr) ) return 3;//Sprawdzanie czy lancuch nie jest pusty
ask.data=atoi(cmd_ptr);//Konwersja cmd_ptr na int i zapis wartosci int do struktury ASK
cmd_ptr=strtok_r(NULL, whitesigns.EOT, &rest);//Wyluskanie lancucha z CRC8 dla danych przed [EOT]
if( strlen(cmd_ptr) ) return 4;//Sprawdzanie czy lancuch nie jest pusty
ask.data_crc8=atoi(cmd_ptr);//Konwersja cmd_ptr na int i zapis wartosci int do struktury ASK
return 1; //Potwierdzenie odbioru danych
}
else
{
return -1;//Wyslanie ERR
}
}[/syntax]
2. Funkcja "analizująca":
[syntax=c]void Make485Cmd( char * ptrbuf )
{
char tmp[10];
int8_t state = ParseUsartData( ptrbuf );
if( 0 == state )
{
SendMode(TRUE);//zalaczenia nadajnika
rs485_delay();
USART_Puts( USART1, itoa(state, tmp, 10) );//DEBUG
USART_Puts( USART1, "ErrAdr\r" );//DEBUG
USART_Puts( USART1, ParseBuf );//DEBUG
}
if( 1 == state )
{
switch( ask.cmd_id )
{
case 0x01:nfo_service(&ask);break;
case 0x02:break;
case 0x03:break;
case 0x04:break;
case 0x05:break;
}
}
if( 2 == state )
{
SendMode(TRUE);//zalaczenia nadajnika
rs485_delay();
USART_Puts( USART1, itoa(state, tmp, 10) );//DEBUG
USART_Puts( USART1, "StrEmpty\r" );//DEBUG
USART_Puts( USART1, ParseBuf );//DEBUG
}
if( -1 == state )
{
SendMode(TRUE);//zalaczenia nadajnika
rs485_delay();
USART_Puts( USART1, itoa(state, tmp, 10) );//DEBUG
USART_Puts( USART1, "FrameError\r" );//DEBUG
USART_Puts( USART1, ParseBuf );//DEBUG
}
}[/syntax]
Problem polega na tym, że jak wysyłam z terminala jakąś przykładowa ramkę funkcja ParseUsartData zwraca mi wartość -1 , tzn. że niby w buforze nie ma znaku SOH (Pierwszy if w funkcji ParseUsartData). Natomiast jak odeślę ten bufor z powrotem do kompa (wewnątrz funkcji Make485Cmd)to niby wszystko w nim jest. Zaznaczony fragment na screenie. Chciałbym prosić kogoś o podpowiedz co robię źle? bo już pomysły mi się skończyły...
screen z terminala:
P.S.
w polu Send wpisane są takie kocie rzeczy jak $01. Bray Terminal rozumie to jako 0x01 itd.
Statystyki: Napisane przez simoon87 — 11 lis 2015, o 21:25
]]>