/Transportables_Koptertool/tags/V-0.1/motortest.c |
---|
0,0 → 1,52 |
#include <avr/io.h> |
#include <inttypes.h> |
#include <stdlib.h> |
#include <avr/pgmspace.h> |
#include "main.h" |
#include "motortest.h" |
#include "lcd.h" |
#include "base64.h" |
void motor_test(void) |
{ |
lcd_cls(); |
while (key != 0x00); |
lcd_printp(PSTR("Taste drücken\r\n"),0); |
while (key == 0x00); |
if (key == 0x08) // nur, wenn die Bestätigungstaste gedrückt wird |
{ |
p_buffer[0] = '#'; // Motoren einschalten |
p_buffer[1] = 'a'; |
p_buffer[2] = 't'; |
p_buffer[3] = 10; |
p_buffer[4] = 10; |
p_buffer[5] = 10; |
p_buffer[6] = 10; |
p_buffer[7] = 0; |
p_buffer[8] = 0; |
base64_send(9); |
} |
while (key != 0x00); |
while (key == 0x00); |
p_buffer[0] = '#'; // Motoren ausschalten |
p_buffer[1] = 'a'; |
p_buffer[2] = 't'; |
p_buffer[3] = 0; |
p_buffer[4] = 0; |
p_buffer[5] = 0; |
p_buffer[6] = 0; |
p_buffer[7] = 0; |
p_buffer[8] = 0; |
base64_send(9); |
} |