- consumed = 1+cmd_length;
- }
- else
- {
- serial_write(0xFE);
- serial_write(FRAMING_ERROR);
- consumed = 1;
- }
-
- recv_tail += consumed;
- if(recv_tail>=sizeof(recv_buf))
- recv_tail -= sizeof(recv_buf);
- recv_fill -= consumed;
-
- if(cmd_length>0)
- {
- uint8_t result = process_command();
- serial_write(0xFE);
- serial_write(result);
+ uint8_t result = dispatch_command(cmd, length);
+ interface_send1(result);