Revision 1204
Implemented single motor testing
| comm_server.c | ||
|---|---|---|
| 188 | 188 |
|
| 189 | 189 |
static void handle_message_start_test_comm (char *buffer) |
| 190 | 190 |
{
|
| 191 |
// TODO handle all/number |
|
| 192 | 191 |
test_comm (); |
| 193 | 192 |
} |
| 194 | 193 |
|
| ... | ... | |
| 246 | 245 |
|
| 247 | 246 |
static void handle_message_start_test (char *buffer) |
| 248 | 247 |
{
|
| 249 |
// FIXME parameter handling |
|
| 250 |
// Parameters: all/rangefinder/motor/encoder all/<num> |
|
| 251 |
|
|
| 252 |
|
|
| 253 | 248 |
// TODO add required comm test |
| 254 | 249 |
buffer=find_next_parameter (buffer); |
| 255 | 250 |
if (!buffer) parameter_missing (); |
| ... | ... | |
| 321 | 316 |
// ## Main loop ## |
| 322 | 317 |
// ############### |
| 323 | 318 |
|
| 319 |
static void ready () |
|
| 320 |
{
|
|
| 321 |
usb_puts ("# Ready" NL);
|
|
| 322 |
} |
|
| 323 |
|
|
| 324 | 324 |
void server_main (void) |
| 325 | 325 |
{
|
| 326 | 326 |
char buffer[buffer_size]; |
| ... | ... | |
| 331 | 331 |
|
| 332 | 332 |
usb_puts (NL); |
| 333 | 333 |
usb_puts ("# Diagnostic station server mode" NL);
|
| 334 |
|
|
| 335 |
ready (); |
|
| 334 | 336 |
|
| 335 | 337 |
while (1) |
| 336 | 338 |
{
|
| ... | ... | |
| 350 | 352 |
|
| 351 | 353 |
// Handle the message. |
| 352 | 354 |
handle_message (buffer); |
| 353 |
|
|
| 355 |
|
|
| 354 | 356 |
// Reset the buffer |
| 355 | 357 |
buffer_fill=0; |
| 356 | 358 |
} |
| 359 |
|
|
| 360 |
// TODO do better, make a function get_message? |
|
| 361 |
ready (); |
|
| 357 | 362 |
} |
| 358 | 363 |
else if (c==8) |
| 359 | 364 |
{
|
Also available in: Unified diff