Bayley Wang / Mbed 2 deprecated foc-ed_in_the_bot_compact

Dependencies:   FastPWM3 mbed

Committer:
bwang
Date:
Fri Feb 09 03:49:31 2018 +0000
Revision:
181:d3510c8beab6
Child:
184:633119bb0b77
02/08/2018 22:48 - integrated CommandProcessor and PreferenceWriter (but code does not use dynamic config variables or set error flags yet)

Who changed what in which revision?

UserRevisionLine numberNew contents of line
bwang 181:d3510c8beab6 1 #include "mbed.h"
bwang 181:d3510c8beab6 2 #include "CommandProcessor.h"
bwang 181:d3510c8beab6 3 #include "PreferenceWriter.h"
bwang 181:d3510c8beab6 4
bwang 181:d3510c8beab6 5 #include "prefs.h"
bwang 181:d3510c8beab6 6 #include "globals.h"
bwang 181:d3510c8beab6 7
bwang 181:d3510c8beab6 8 #include "config_driving.h"
bwang 181:d3510c8beab6 9 #include "config_inverter.h"
bwang 181:d3510c8beab6 10 #include "config_logging.h"
bwang 181:d3510c8beab6 11 #include "config_loop.h"
bwang 181:d3510c8beab6 12 #include "config_motor.h"
bwang 181:d3510c8beab6 13 #include "config_pins.h"
bwang 181:d3510c8beab6 14 #include "config_table.h"
bwang 181:d3510c8beab6 15
bwang 181:d3510c8beab6 16 void cmd_setp(Serial *pc, char *buf) {
bwang 181:d3510c8beab6 17 if (BREMS_src == CMD_SRC_TERMINAL) control.user_cmd = atof(buf);
bwang 181:d3510c8beab6 18 }
bwang 181:d3510c8beab6 19
bwang 181:d3510c8beab6 20 void cmd_mode(Serial *pc, char *buf) {
bwang 181:d3510c8beab6 21 int n = str_to_mode(buf);
bwang 181:d3510c8beab6 22 if (n < 0) {
bwang 181:d3510c8beab6 23 pc->printf("%s\n", "Invalid Mode");
bwang 181:d3510c8beab6 24 return;
bwang 181:d3510c8beab6 25 }
bwang 181:d3510c8beab6 26 BREMS_mode = n;
bwang 181:d3510c8beab6 27 pc->printf("Set mode to %s\n", mode_to_str(n));
bwang 181:d3510c8beab6 28 }
bwang 181:d3510c8beab6 29
bwang 181:d3510c8beab6 30 void cmd_src(Serial *pc, char *buf) {
bwang 181:d3510c8beab6 31 int n = str_to_src(buf);
bwang 181:d3510c8beab6 32 if (n < 0) {
bwang 181:d3510c8beab6 33 pc->printf("%s\n", "Invalid Source");
bwang 181:d3510c8beab6 34 return;
bwang 181:d3510c8beab6 35 }
bwang 181:d3510c8beab6 36 BREMS_src = n;
bwang 181:d3510c8beab6 37 pc->printf("Set source to %s\n", src_to_str(n));
bwang 181:d3510c8beab6 38 }
bwang 181:d3510c8beab6 39
bwang 181:d3510c8beab6 40 void cmd_op(Serial *pc, char *buf) {
bwang 181:d3510c8beab6 41 int n = str_to_op(buf);
bwang 181:d3510c8beab6 42 if (n < 0) {
bwang 181:d3510c8beab6 43 pc->printf("%s\n", "Invalid Source");
bwang 181:d3510c8beab6 44 return;
bwang 181:d3510c8beab6 45 }
bwang 181:d3510c8beab6 46 BREMS_op = n;
bwang 181:d3510c8beab6 47 pc->printf("Set operation to %s\n", op_to_str(n));
bwang 181:d3510c8beab6 48 }
bwang 181:d3510c8beab6 49
bwang 181:d3510c8beab6 50 void cmd_exit(Serial *pc) {
bwang 181:d3510c8beab6 51 BREMS_mode = MODE_RUN;
bwang 181:d3510c8beab6 52 pc->printf("%s\n", "Run mode ON");
bwang 181:d3510c8beab6 53 }