Pierwsze
[syntax=c]#include <avr/io.h>
#include <avr/interrupt.h>
#include <avr/pgmspace.h>
#include <util/delay.h>
#include <string.h>
#include <stdlib.h>
#include "MKUART/mkuart.h"
#define BUFOR_SIZE16
#define MOTOR_NAME_SIZE7
#define MOTOR_VAL_SIZE3
char bufor[BUFOR_SIZE];
char motor_name_str[MOTOR_NAME_SIZE+1];//np. silnik1 + NULL
char motor_value_str[MOTOR_VAL_SIZE+1];//wartość np.255 + NULL
uint8_t motor1, motor2;
uint8_t get_string(char * buf);
int main(void)
{
USART_Init(__UBRR);
sei();
DDRD |= (1<<PD4) | (1<<PD5);//OC1A i OC1B jako - wyjscia
//timer1 - Fast Pwm 8bit
TCCR1A |= (1<<WGM10);
TCCR1B |= (1<<WGM12);
TCCR1B |= (1<<CS11);
TCCR1A |= (1<<COM1A1) | (1<<COM1A0);
TCCR1A |= (1<<COM1B1) | (1<<COM1B0);
OCR1A = 0;
OCR1B = 0;
while(!0)
{
if( get_string( bufor ))
{
//zerujemy bufory
memset(motor_name_str, 0, sizeof(motor_name_str));
memset(motor_value_str, 0, sizeof(motor_value_str));
//kopiujemy nazwę silnika z bufor do motor_number_str
memcpy(motor_name_str, bufor, MOTOR_NAME_SIZE);
//kopiujemy wartość pwm z bufor do motor_value_str
//odczytywanie rozpoczynamy od znaku za nazwą silnika
memcpy(motor_value_str, &bufor[MOTOR_NAME_SIZE], MOTOR_VAL_SIZE);
if( 0 == strcasecmp("silnik1", motor_name_str) )
{
motor1 = atoi(motor_value_str);
}
if( 0 == strcasecmp("silnik2", motor_name_str) )
{
motor2 = atoi(motor_value_str);
}
}
OCR1A = motor1;
OCR1B = motor2;
}
}
uint8_t get_string(char * buf)
{
uint8_t znak;
static uint8_t i;
//pobierz bajt z bufora odbiorczego
//funkcja uart_getc zwraca zero jeśli nie odczytała żadnego
//znaku z bufora odbiorczego
znak = uart_getc();
//'\0' - funkcja nie odczytała żadnego znaku
//'\n' - ignorujemy kod znaku "nowej linii" LF
if( (znak == '\0') || (znak == '\n') ) return 0;
if(znak != '\r' )//jeśli odebrany znak jest różny od kodu znaku CR
{
buf[i] = znak;//zapisz znak do bufora
i++;
}
else//jeśli odebrano kod znaku CR
{
buf[i] = '\0';//zapisz do bufora znak NULL
i=0;//aby w buforze utworzyć C-string zakończony zerem
return 1;
}
return 0;
}[/syntax]
Drugie rozwiązanie opiera się na funkcji strtok(). Przesyłany ciągu znaków powinien mieć postać np. silnik1-123, silnik2-030, gdzie "-" to separator zdefiniowany na początku programu.
[syntax=c]#include <avr/io.h>
#include <avr/interrupt.h>
#include <avr/pgmspace.h>
#include <util/delay.h>
#include <string.h>
#include <stdlib.h>
#include "MKUART/mkuart.h"
#define BUFOR_SIZE16
char bufor[BUFOR_SIZE];
char separator[] = "-";
char *motor_name_wsk;
char *motor_value_wsk;
uint8_t motor1, motor2;
uint8_t get_string(char * buf);
int main(void)
{
USART_Init(__UBRR);
sei();
DDRD |= (1<<PD4) | (1<<PD5);
TCCR1A |= (1<<WGM10);
TCCR1B |= (1<<WGM12);
TCCR1B |= (1<<CS11);
TCCR1A |= (1<<COM1A1) | (1<<COM1A0);
TCCR1A |= (1<<COM1B1) | (1<<COM1B0);
OCR1A = 0;
OCR1B = 0;
while(!0)
{
if( get_string( bufor ))
{
motor_name_wsk = strtok(bufor, separator);
motor_value_wsk = strtok(NULL, separator);
if( 0 == strcasecmp("silnik1", motor_name_wsk) )
{
motor1 = atoi(motor_value_wsk);
}
if( 0 == strcasecmp("silnik2", motor_name_wsk) )
{
motor2 = atoi(motor_value_wsk);
}
}
OCR1A = motor1;
OCR1B = motor2;
}
}
uint8_t get_string(char * buf)
{
uint8_t znak;
static uint8_t i;
//pobierz bajt z bufora odbiorczego
//funkcja uart_getc zwraca zero jeśli nie odczytała żadnego
//znaku z bufora odbiorczego
znak = uart_getc();
//'\0' - funkcja nie odczytała żadnego znaku
//'\n' - ignorujemy kod znaku "nowej linii" LF
if( (znak == '\0') || (znak == '\n') ) return 0;
if(znak != '\r' )//jeśli odebrany znak jest różny od kodu znaku CR
{
buf[i] = znak;//zapisz znak do bufora
i++;
}
else//jeśli odebrano kod znaku CR
{
buf[i] = '\0';//zapisz do bufora znak NULL
i=0;//aby w buforze utworzyć C-string zakończony zerem
return 1;
}
return 0;
}[/syntax]
Miłej analizy
Statystyki: Napisane przez jacekk232 — 30 sie 2014, o 20:45
]]>
