static void dyn1_execute(void) {
size_t n, sz;
void *p1;
tprio_t prio = chThdGetPriority();
(void)chHeapStatus(&heap1, &sz);
/* Starting threads from the heap. */
threads[0] = chThdCreateFromHeap(&heap1, THD_WA_SIZE(THREADS_STACK_SIZE),
prio-1, thread, "A");
threads[1] = chThdCreateFromHeap(&heap1, THD_WA_SIZE(THREADS_STACK_SIZE),
prio-2, thread, "B");
/* Allocating the whole heap in order to make the thread creation fail.*/
(void)chHeapStatus(&heap1, &n);
p1 = chHeapAlloc(&heap1, n);
threads[2] = chThdCreateFromHeap(&heap1, THD_WA_SIZE(THREADS_STACK_SIZE),
prio-3, thread, "C");
chHeapFree(p1);
test_assert(1, (threads[0] != NULL) &&
(threads[1] != NULL) &&
(threads[2] == NULL) &&
(threads[3] == NULL) &&
(threads[4] == NULL),
"thread creation failed");
/* Claiming the memory from terminated threads. */
test_wait_threads();
test_assert_sequence(2, "AB");
/* Heap status checked again.*/
test_assert(3, chHeapStatus(&heap1, &n) == 1, "heap fragmented");
test_assert(4, n == sz, "heap size changed");
}
static void cmd_mem(BaseSequentialStream *chp, int argc, char *argv[]) {
size_t n, size;
(void)argv;
if (argc > 0) {
chprintf(chp, "Usage: mem\r\n");
return;
}
n = chHeapStatus(NULL, &size);
chprintf(chp, "core free memory : %u bytes\r\n", chCoreStatus());
chprintf(chp, "heap fragments : %u\r\n", n);
chprintf(chp, "heap free total : %u bytes\r\n", size);
}
static void cmd_mem( int argc, char *argv[] )
{
size_t n, size;
(void)argv;
if( argc > 0 )
{
usage( "mem" );
return;
}
n = chHeapStatus( NULL, &size );
chprint( "core free memory : %u bytes\r\n", chCoreGetStatusX() );
chprint( "heap fragments : %u\r\n", n );
chprint( "heap free total : %u bytes\r\n", size );
}
static void cmd_mem(BaseChannel *chp, int argc, char *argv[]) {
size_t n, size;
char buf[52];
(void)argv;
if (argc > 0) {
shellPrintLine(chp, "Usage: mem");
return;
}
n = chHeapStatus(NULL, &size);
siprintf(buf, "core free memory : %lu bytes", chCoreStatus());
shellPrintLine(chp, buf);
siprintf(buf, "heap fragments : %lu", n);
shellPrintLine(chp, buf);
siprintf(buf, "heap free total : %lu bytes", size);
shellPrintLine(chp, buf);
}
DebugMemoryView::DebugMemoryView(NavigationView& nav) {
add_children({ {
&text_title,
&text_label_m0_free,
&text_label_m0_free_value,
&text_label_m0_heap_fragmented_free,
&text_label_m0_heap_fragmented_free_value,
&text_label_m0_heap_fragments,
&text_label_m0_heap_fragments_value,
&button_done
} });
const auto m0_free = chCoreStatus();
text_label_m0_free_value.set(to_string_dec_uint(m0_free, 5));
size_t m0_fragmented_free_space = 0;
const auto m0_fragments = chHeapStatus(NULL, &m0_fragmented_free_space);
text_label_m0_heap_fragmented_free_value.set(to_string_dec_uint(m0_fragmented_free_space, 5));
text_label_m0_heap_fragments_value.set(to_string_dec_uint(m0_fragments, 5));
button_done.on_select = [&nav](Button&){ nav.pop(); };
}
static void heap1_execute(void) {
void *p1, *p2, *p3;
size_t n, sz;
/* Unrelated, for coverage only.*/
(void)chCoreStatus();
/*
* Test on the default heap in order to cover the core allocator at
* least one time.
*/
(void)chHeapStatus(NULL, &sz);
p1 = chHeapAlloc(NULL, SIZE);
test_assert(1, p1 != NULL, "allocation failed");
chHeapFree(p1);
p1 = chHeapAlloc(NULL, (size_t)-256);
test_assert(2, p1 == NULL, "allocation not failed");
/* Initial local heap state.*/
(void)chHeapStatus(&test_heap, &sz);
/* Same order.*/
p1 = chHeapAlloc(&test_heap, SIZE);
p2 = chHeapAlloc(&test_heap, SIZE);
p3 = chHeapAlloc(&test_heap, SIZE);
chHeapFree(p1); /* Does not merge.*/
chHeapFree(p2); /* Merges backward.*/
chHeapFree(p3); /* Merges both sides.*/
test_assert(3, chHeapStatus(&test_heap, &n) == 1, "heap fragmented");
/* Reverse order.*/
p1 = chHeapAlloc(&test_heap, SIZE);
p2 = chHeapAlloc(&test_heap, SIZE);
p3 = chHeapAlloc(&test_heap, SIZE);
chHeapFree(p3); /* Merges forward.*/
chHeapFree(p2); /* Merges forward.*/
chHeapFree(p1); /* Merges forward.*/
test_assert(4, chHeapStatus(&test_heap, &n) == 1, "heap fragmented");
/* Small fragments handling.*/
p1 = chHeapAlloc(&test_heap, SIZE + 1);
p2 = chHeapAlloc(&test_heap, SIZE);
chHeapFree(p1);
test_assert(5, chHeapStatus(&test_heap, &n) == 2, "invalid state");
p1 = chHeapAlloc(&test_heap, SIZE);
/* Note, the first situation happens when the alignment size is smaller
than the header size, the second in the other cases.*/
test_assert(6, (chHeapStatus(&test_heap, &n) == 1) ||
(chHeapStatus(&test_heap, &n) == 2), "heap fragmented");
chHeapFree(p2);
chHeapFree(p1);
test_assert(7, chHeapStatus(&test_heap, &n) == 1, "heap fragmented");
/* Skip fragment handling.*/
p1 = chHeapAlloc(&test_heap, SIZE);
p2 = chHeapAlloc(&test_heap, SIZE);
chHeapFree(p1);
test_assert(8, chHeapStatus(&test_heap, &n) == 2, "invalid state");
p1 = chHeapAlloc(&test_heap, SIZE * 2); /* Skips first fragment.*/
chHeapFree(p1);
chHeapFree(p2);
test_assert(9, chHeapStatus(&test_heap, &n) == 1, "heap fragmented");
/* Allocate all handling.*/
(void)chHeapStatus(&test_heap, &n);
p1 = chHeapAlloc(&test_heap, n);
test_assert(10, chHeapStatus(&test_heap, &n) == 0, "not empty");
chHeapFree(p1);
test_assert(11, chHeapStatus(&test_heap, &n) == 1, "heap fragmented");
test_assert(12, n == sz, "size changed");
}
void terminal_process_string(char *str) {
enum { kMaxArgs = 64 };
int argc = 0;
char *argv[kMaxArgs];
char *p2 = strtok(str, " ");
while (p2 && argc < kMaxArgs) {
argv[argc++] = p2;
p2 = strtok(0, " ");
}
if (argc == 0) {
commands_printf("No command received\n");
return;
}
if (strcmp(argv[0], "ping") == 0) {
commands_printf("pong\n");
} else if (strcmp(argv[0], "stop") == 0) {
mcpwm_set_duty(0);
commands_printf("Motor stopped\n");
} else if (strcmp(argv[0], "last_adc_duration") == 0) {
commands_printf("Latest ADC duration: %.4f ms", (double)(mcpwm_get_last_adc_isr_duration() * 1000.0));
commands_printf("Latest injected ADC duration: %.4f ms", (double)(mcpwm_get_last_inj_adc_isr_duration() * 1000.0));
commands_printf("Latest main ADC duration: %.4f ms\n", (double)(main_get_last_adc_isr_duration() * 1000.0));
} else if (strcmp(argv[0], "kv") == 0) {
commands_printf("Calculated KV: %.2f rpm/volt\n", (double)mcpwm_get_kv_filtered());
} else if (strcmp(argv[0], "mem") == 0) {
size_t n, size;
n = chHeapStatus(NULL, &size);
commands_printf("core free memory : %u bytes", chCoreStatus());
commands_printf("heap fragments : %u", n);
commands_printf("heap free total : %u bytes\n", size);
} else if (strcmp(argv[0], "threads") == 0) {
Thread *tp;
static const char *states[] = {THD_STATE_NAMES};
commands_printf(" addr stack prio refs state name time ");
commands_printf("-------------------------------------------------------------");
tp = chRegFirstThread();
do {
commands_printf("%.8lx %.8lx %4lu %4lu %9s %14s %lu",
(uint32_t)tp, (uint32_t)tp->p_ctx.r13,
(uint32_t)tp->p_prio, (uint32_t)(tp->p_refs - 1),
states[tp->p_state], tp->p_name, (uint32_t)tp->p_time);
tp = chRegNextThread(tp);
} while (tp != NULL);
commands_printf("");
} else if (strcmp(argv[0], "fault") == 0) {
commands_printf("%s\n", mcpwm_fault_to_string(mcpwm_get_fault()));
} else if (strcmp(argv[0], "faults") == 0) {
if (fault_vec_write == 0) {
commands_printf("No faults registered since startup\n");
} else {
commands_printf("The following faults were registered since start:\n");
for (int i = 0;i < fault_vec_write;i++) {
commands_printf("Fault : %s", mcpwm_fault_to_string(fault_vec[i].fault));
commands_printf("Current : %.1f", (double)fault_vec[i].current);
commands_printf("Current filtered : %.1f", (double)fault_vec[i].current_filtered);
commands_printf("Voltage : %.2f", (double)fault_vec[i].voltage);
commands_printf("Duty : %.2f", (double)fault_vec[i].duty);
commands_printf("RPM : %.1f", (double)fault_vec[i].rpm);
commands_printf("Tacho : %d", fault_vec[i].tacho);
commands_printf("TIM PWM CNT : %d", fault_vec[i].tim_pwm_cnt);
commands_printf("TIM Samp CNT : %d", fault_vec[i].tim_samp_cnt);
commands_printf("Comm step : %d", fault_vec[i].comm_step);
commands_printf("Temperature : %.2f\n", (double)fault_vec[i].temperature);
}
}
} else if (strcmp(argv[0], "rpm") == 0) {
commands_printf("Electrical RPM: %.2f rpm\n", (double)mcpwm_get_rpm());
} else if (strcmp(argv[0], "tacho") == 0) {
commands_printf("Tachometer counts: %i\n", mcpwm_get_tachometer_value(0));
} else if (strcmp(argv[0], "tim") == 0) {
chSysLock();
volatile int t1_cnt = TIM1->CNT;
volatile int t8_cnt = TIM8->CNT;
chSysUnlock();
int duty = TIM1->CCR1;
int top = TIM1->ARR;
int voltage_samp = TIM8->CCR1;
int current1_samp = TIM1->CCR4;
int current2_samp = TIM8->CCR2;
commands_printf("Tim1 CNT: %i", t1_cnt);
commands_printf("Tim8 CNT: %u", t8_cnt);
commands_printf("Duty cycle: %u", duty);
commands_printf("Top: %u", top);
commands_printf("Voltage sample: %u", voltage_samp);
commands_printf("Current 1 sample: %u", current1_samp);
commands_printf("Current 2 sample: %u\n", current2_samp);
} else if (strcmp(argv[0], "volt") == 0) {
commands_printf("Input voltage: %.2f\n", (double)GET_INPUT_VOLTAGE());
} else if (strcmp(argv[0], "param_detect") == 0) {
// Use COMM_MODE_DELAY and try to figure out the motor parameters.
if (argc == 4) {
float current = -1.0;
float min_rpm = -1.0;
float low_duty = -1.0;
sscanf(argv[1], "%f", ¤t);
sscanf(argv[2], "%f", &min_rpm);
sscanf(argv[3], "%f", &low_duty);
const volatile mc_configuration *mcconf = mcpwm_get_configuration();
if (current > 0.0 && current < mcconf->l_current_max &&
min_rpm > 10.0 && min_rpm < 3000.0 &&
low_duty > 0.02 && low_duty < 0.8) {
float cycle_integrator;
float coupling_k;
if (conf_general_detect_motor_param(current, min_rpm, low_duty, &cycle_integrator, &coupling_k)) {
commands_printf("Cycle integrator limit: %.2f", (double)cycle_integrator);
commands_printf("Coupling factor: %.2f\n", (double)coupling_k);
} else {
commands_printf("Detection failed. Try again with different parameters.\n");
}
} else {
commands_printf("Invalid argument(s).\n");
}
} else {
commands_printf("This command requires three arguments.\n");
}
} else if (strcmp(argv[0], "rpm_dep") == 0) {
mc_rpm_dep_struct rpm_dep = mcpwm_get_rpm_dep();
commands_printf("Cycle int limit: %.2f", (double)rpm_dep.cycle_int_limit);
commands_printf("Cycle int limit running: %.2f", (double)rpm_dep.cycle_int_limit_running);
commands_printf("Cycle int limit max: %.2f\n", (double)rpm_dep.cycle_int_limit_max);
}
// Setters
else if (strcmp(argv[0], "set_hall_table") == 0) {
if (argc == 4) {
int dir = -1;
int fwd_add = -1;
int rev_add = -1;
sscanf(argv[1], "%i", &dir);
sscanf(argv[2], "%i", &fwd_add);
sscanf(argv[3], "%i", &rev_add);
if (dir >= 0 && fwd_add >= 0 && rev_add >= 0) {
mcpwm_init_hall_table(dir, fwd_add, rev_add);
commands_printf("New hall sensor dir: %i fwd_add %i rev_add %i\n",
dir, fwd_add, rev_add);
} else {
commands_printf("Invalid argument(s).\n");
}
} else {
commands_printf("This command requires three arguments.\n");
}
}
// The help command
else if (strcmp(argv[0], "help") == 0) {
commands_printf("Valid commands are:");
commands_printf("help");
commands_printf(" Show this help");
commands_printf("ping");
commands_printf(" Print pong here to see if the reply works");
commands_printf("stop");
commands_printf(" Stop the motor");
commands_printf("last_adc_duration");
commands_printf(" The time the latest ADC interrupt consumed");
commands_printf("kv");
commands_printf(" The calculated kv of the motor");
commands_printf("mem");
commands_printf(" Show memory usage");
commands_printf("threads");
commands_printf(" List all threads");
commands_printf("fault");
commands_printf(" Prints the current fault code");
commands_printf("faults");
commands_printf(" Prints all stored fault codes and conditions when they arrived");
commands_printf("rpm");
commands_printf(" Prints the current electrical RPM");
commands_printf("tacho");
commands_printf(" Prints tachometer value");
commands_printf("tim");
commands_printf(" Prints tim1 and tim8 settings");
commands_printf("set_hall_table [dir] [fwd_add] [rev_add]");
commands_printf(" Update the hall sensor lookup table");
commands_printf("volt");
commands_printf(" Prints different voltages");
commands_printf("param_detect [current] [min_rpm] [low_duty]");
commands_printf(" Spin up the motor in COMM_MODE_DELAY and compute its parameters.");
commands_printf(" This test should be performed without load on the motor.");
commands_printf(" Example: param_detect 5.0 600 0.06");
commands_printf("rpm_dep");
commands_printf(" Prints some rpm-dep values\n");
} else {
commands_printf("Invalid command: %s\n"
"type help to list all available commands\n", argv[0]);
}
}
void terminal_process_string(char *str) {
enum { kMaxArgs = 64 };
int argc = 0;
char *argv[kMaxArgs];
char *p2 = strtok(str, " ");
while (p2 && argc < kMaxArgs) {
argv[argc++] = p2;
p2 = strtok(0, " ");
}
if (argc == 0) {
commands_printf("No command received\n");
return;
}
static mc_configuration mcconf; // static to save some stack
static mc_configuration mcconf_old; // static to save some stack
mcconf = *mc_interface_get_configuration();
mcconf_old = mcconf;
if (strcmp(argv[0], "ping") == 0) {
commands_printf("pong\n");
} else if (strcmp(argv[0], "stop") == 0) {
mc_interface_set_duty(0);
commands_printf("Motor stopped\n");
} else if (strcmp(argv[0], "last_adc_duration") == 0) {
commands_printf("Latest ADC duration: %.4f ms", (double)(mcpwm_get_last_adc_isr_duration() * 1000.0));
commands_printf("Latest injected ADC duration: %.4f ms", (double)(mc_interface_get_last_inj_adc_isr_duration() * 1000.0));
commands_printf("Latest sample ADC duration: %.4f ms\n", (double)(mc_interface_get_last_sample_adc_isr_duration() * 1000.0));
} else if (strcmp(argv[0], "kv") == 0) {
commands_printf("Calculated KV: %.2f rpm/volt\n", (double)mcpwm_get_kv_filtered());
} else if (strcmp(argv[0], "mem") == 0) {
size_t n, size;
n = chHeapStatus(NULL, &size);
commands_printf("core free memory : %u bytes", chCoreGetStatusX());
commands_printf("heap fragments : %u", n);
commands_printf("heap free total : %u bytes\n", size);
} else if (strcmp(argv[0], "threads") == 0) {
thread_t *tp;
static const char *states[] = {CH_STATE_NAMES};
commands_printf(" addr stack prio refs state name time ");
commands_printf("-------------------------------------------------------------");
tp = chRegFirstThread();
do {
commands_printf("%.8lx %.8lx %4lu %4lu %9s %14s %lu",
(uint32_t)tp, (uint32_t)tp->p_ctx.r13,
(uint32_t)tp->p_prio, (uint32_t)(tp->p_refs - 1),
states[tp->p_state], tp->p_name, (uint32_t)tp->p_time);
tp = chRegNextThread(tp);
} while (tp != NULL);
commands_printf("");
} else if (strcmp(argv[0], "fault") == 0) {
commands_printf("%s\n", mc_interface_fault_to_string(mc_interface_get_fault()));
} else if (strcmp(argv[0], "faults") == 0) {
if (fault_vec_write == 0) {
commands_printf("No faults registered since startup\n");
} else {
commands_printf("The following faults were registered since start:\n");
for (int i = 0;i < fault_vec_write;i++) {
commands_printf("Fault : %s", mc_interface_fault_to_string(fault_vec[i].fault));
commands_printf("Current : %.1f", (double)fault_vec[i].current);
commands_printf("Current filtered : %.1f", (double)fault_vec[i].current_filtered);
commands_printf("Voltage : %.2f", (double)fault_vec[i].voltage);
commands_printf("Duty : %.2f", (double)fault_vec[i].duty);
commands_printf("RPM : %.1f", (double)fault_vec[i].rpm);
commands_printf("Tacho : %d", fault_vec[i].tacho);
commands_printf("Cycles running : %d", fault_vec[i].cycles_running);
commands_printf("TIM duty : %d", (int)((float)fault_vec[i].tim_top * fault_vec[i].duty));
commands_printf("TIM val samp : %d", fault_vec[i].tim_val_samp);
commands_printf("TIM current samp : %d", fault_vec[i].tim_current_samp);
commands_printf("TIM top : %d", fault_vec[i].tim_top);
commands_printf("Comm step : %d", fault_vec[i].comm_step);
commands_printf("Temperature : %.2f\n", (double)fault_vec[i].temperature);
}
}
} else if (strcmp(argv[0], "rpm") == 0) {
commands_printf("Electrical RPM: %.2f rpm\n", (double)mc_interface_get_rpm());
} else if (strcmp(argv[0], "tacho") == 0) {
commands_printf("Tachometer counts: %i\n", mc_interface_get_tachometer_value(0));
} else if (strcmp(argv[0], "tim") == 0) {
chSysLock();
volatile int t1_cnt = TIM1->CNT;
volatile int t8_cnt = TIM8->CNT;
volatile int dir1 = !!(TIM1->CR1 & (1 << 4));
volatile int dir8 = !!(TIM8->CR1 & (1 << 4));
chSysUnlock();
int duty1 = TIM1->CCR1;
int duty2 = TIM1->CCR2;
int duty3 = TIM1->CCR3;
int top = TIM1->ARR;
int voltage_samp = TIM8->CCR1;
int current1_samp = TIM1->CCR4;
int current2_samp = TIM8->CCR2;
commands_printf("Tim1 CNT: %i", t1_cnt);
commands_printf("Tim8 CNT: %u", t8_cnt);
commands_printf("Duty cycle1: %u", duty1);
commands_printf("Duty cycle2: %u", duty2);
commands_printf("Duty cycle3: %u", duty3);
commands_printf("Top: %u", top);
commands_printf("Dir1: %u", dir1);
commands_printf("Dir8: %u", dir8);
commands_printf("Voltage sample: %u", voltage_samp);
commands_printf("Current 1 sample: %u", current1_samp);
commands_printf("Current 2 sample: %u\n", current2_samp);
} else if (strcmp(argv[0], "volt") == 0) {
commands_printf("Input voltage: %.2f\n", (double)GET_INPUT_VOLTAGE());
} else if (strcmp(argv[0], "param_detect") == 0) {
// Use COMM_MODE_DELAY and try to figure out the motor parameters.
if (argc == 4) {
float current = -1.0;
float min_rpm = -1.0;
float low_duty = -1.0;
sscanf(argv[1], "%f", ¤t);
sscanf(argv[2], "%f", &min_rpm);
sscanf(argv[3], "%f", &low_duty);
if (current > 0.0 && current < mcconf.l_current_max &&
min_rpm > 10.0 && min_rpm < 3000.0 &&
low_duty > 0.02 && low_duty < 0.8) {
float cycle_integrator;
float coupling_k;
int8_t hall_table[8];
int hall_res;
if (conf_general_detect_motor_param(current, min_rpm, low_duty, &cycle_integrator, &coupling_k, hall_table, &hall_res)) {
commands_printf("Cycle integrator limit: %.2f", (double)cycle_integrator);
commands_printf("Coupling factor: %.2f", (double)coupling_k);
if (hall_res == 0) {
commands_printf("Detected hall sensor table:");
commands_printf("%i, %i, %i, %i, %i, %i, %i, %i\n",
hall_table[0], hall_table[1], hall_table[2], hall_table[3],
hall_table[4], hall_table[5], hall_table[6], hall_table[7]);
} else if (hall_res == -1) {
commands_printf("Hall sensor detection failed:");
commands_printf("%i, %i, %i, %i, %i, %i, %i, %i\n",
hall_table[0], hall_table[1], hall_table[2], hall_table[3],
hall_table[4], hall_table[5], hall_table[6], hall_table[7]);
} else if (hall_res == -2) {
commands_printf("WS2811 enabled. Hall sensors cannot be used.\n");
} else if (hall_res == -3) {
commands_printf("Encoder enabled. Hall sensors cannot be used.\n");
}
} else {
commands_printf("Detection failed. Try again with different parameters.\n");
}
} else {
commands_printf("Invalid argument(s).\n");
}
} else {
commands_printf("This command requires three arguments.\n");
}
} else if (strcmp(argv[0], "rpm_dep") == 0) {
mc_rpm_dep_struct rpm_dep = mcpwm_get_rpm_dep();
commands_printf("Cycle int limit: %.2f", (double)rpm_dep.cycle_int_limit);
commands_printf("Cycle int limit running: %.2f", (double)rpm_dep.cycle_int_limit_running);
commands_printf("Cycle int limit max: %.2f\n", (double)rpm_dep.cycle_int_limit_max);
} else if (strcmp(argv[0], "can_devs") == 0) {
commands_printf("CAN devices seen on the bus the past second:\n");
for (int i = 0;i < CAN_STATUS_MSGS_TO_STORE;i++) {
can_status_msg *msg = comm_can_get_status_msg_index(i);
if (msg->id >= 0 && UTILS_AGE_S(msg->rx_time) < 1.0) {
commands_printf("ID : %i", msg->id);
commands_printf("RX Time : %i", msg->rx_time);
commands_printf("Age (milliseconds) : %.2f", (double)(UTILS_AGE_S(msg->rx_time) * 1000.0));
commands_printf("RPM : %.2f", (double)msg->rpm);
commands_printf("Current : %.2f", (double)msg->current);
commands_printf("Duty : %.2f\n", (double)msg->duty);
}
}
} else if (strcmp(argv[0], "foc_encoder_detect") == 0) {
if (argc == 2) {
float current = -1.0;
sscanf(argv[1], "%f", ¤t);
if (current > 0.0 && current <= mcconf.l_current_max) {
if (encoder_is_configured()) {
mc_motor_type type_old = mcconf.motor_type;
mcconf.motor_type = MOTOR_TYPE_FOC;
mc_interface_set_configuration(&mcconf);
float offset = 0.0;
float ratio = 0.0;
bool inverted = false;
mcpwm_foc_encoder_detect(current, true, &offset, &ratio, &inverted);
mcconf.motor_type = type_old;
mc_interface_set_configuration(&mcconf);
commands_printf("Offset : %.2f", (double)offset);
commands_printf("Ratio : %.2f", (double)ratio);
commands_printf("Inverted : %s\n", inverted ? "true" : "false");
} else {
commands_printf("Encoder not enabled.\n");
}
} else {
commands_printf("Invalid argument(s).\n");
}
} else {
commands_printf("This command requires one argument.\n");
}
} else if (strcmp(argv[0], "measure_res") == 0) {
if (argc == 2) {
float current = -1.0;
sscanf(argv[1], "%f", ¤t);
if (current > 0.0 && current <= mcconf.l_current_max) {
mcconf.motor_type = MOTOR_TYPE_FOC;
mc_interface_set_configuration(&mcconf);
commands_printf("Resistance: %.6f ohm\n", (double)mcpwm_foc_measure_resistance(current, 2000));
mc_interface_set_configuration(&mcconf_old);
} else {
commands_printf("Invalid argument(s).\n");
}
} else {
commands_printf("This command requires one argument.\n");
}
} else if (strcmp(argv[0], "measure_ind") == 0) {
if (argc == 2) {
float duty = -1.0;
sscanf(argv[1], "%f", &duty);
if (duty > 0.0) {
mcconf.motor_type = MOTOR_TYPE_FOC;
mcconf.foc_f_sw = 3000.0;
mc_interface_set_configuration(&mcconf);
commands_printf("Inductance: %.2f microhenry\n", (double)(mcpwm_foc_measure_inductance(duty, 200, 0)));
mc_interface_set_configuration(&mcconf_old);
} else {
commands_printf("Invalid argument(s).\n");
}
} else {
commands_printf("This command requires one argument.\n");
}
} else if (strcmp(argv[0], "measure_linkage") == 0) {
if (argc == 5) {
float current = -1.0;
float duty = -1.0;
float min_erpm = -1.0;
float res = -1.0;
sscanf(argv[1], "%f", ¤t);
sscanf(argv[2], "%f", &duty);
sscanf(argv[3], "%f", &min_erpm);
sscanf(argv[4], "%f", &res);
if (current > 0.0 && current <= mcconf.l_current_max && min_erpm > 0.0 && duty > 0.02 && res >= 0.0) {
float linkage;
conf_general_measure_flux_linkage(current, duty, min_erpm, res, &linkage);
commands_printf("Flux linkage: %.7f\n", (double)linkage);
} else {
commands_printf("Invalid argument(s).\n");
}
} else {
commands_printf("This command requires one argument.\n");
}
} else if (strcmp(argv[0], "measure_res_ind") == 0) {
mcconf.motor_type = MOTOR_TYPE_FOC;
mc_interface_set_configuration(&mcconf);
float res = 0.0;
float ind = 0.0;
mcpwm_foc_measure_res_ind(&res, &ind);
commands_printf("Resistance: %.6f ohm", (double)res);
commands_printf("Inductance: %.2f microhenry\n", (double)ind);
mc_interface_set_configuration(&mcconf_old);
} else if (strcmp(argv[0], "measure_linkage_foc") == 0) {
if (argc == 2) {
float duty = -1.0;
sscanf(argv[1], "%f", &duty);
if (duty > 0.0) {
mcconf.motor_type = MOTOR_TYPE_FOC;
mc_interface_set_configuration(&mcconf);
const float res = (3.0 / 2.0) * mcconf.foc_motor_r;
// Disable timeout
systime_t tout = timeout_get_timeout_msec();
float tout_c = timeout_get_brake_current();
timeout_configure(60000, 0.0);
for (int i = 0;i < 100;i++) {
mc_interface_set_duty(((float)i / 100.0) * duty);
chThdSleepMilliseconds(20);
}
float vq_avg = 0.0;
float rpm_avg = 0.0;
float samples = 0.0;
float iq_avg = 0.0;
for (int i = 0;i < 1000;i++) {
vq_avg += mcpwm_foc_get_vq();
rpm_avg += mc_interface_get_rpm();
iq_avg += mc_interface_get_tot_current_directional();
samples += 1.0;
chThdSleepMilliseconds(1);
}
mc_interface_release_motor();
mc_interface_set_configuration(&mcconf_old);
// Enable timeout
timeout_configure(tout, tout_c);
vq_avg /= samples;
rpm_avg /= samples;
iq_avg /= samples;
float linkage = (vq_avg - res * iq_avg) / (rpm_avg * ((2.0 * M_PI) / 60.0));
commands_printf("Flux linkage: %.7f\n", (double)linkage);
} else {
commands_printf("Invalid argument(s).\n");
}
} else {
commands_printf("This command requires one argument.\n");
}
} else if (strcmp(argv[0], "foc_state") == 0) {
mcpwm_foc_print_state();
commands_printf(" ");
}
// The help command
else if (strcmp(argv[0], "help") == 0) {
commands_printf("Valid commands are:");
commands_printf("help");
commands_printf(" Show this help");
commands_printf("ping");
commands_printf(" Print pong here to see if the reply works");
commands_printf("stop");
commands_printf(" Stop the motor");
commands_printf("last_adc_duration");
commands_printf(" The time the latest ADC interrupt consumed");
commands_printf("kv");
commands_printf(" The calculated kv of the motor");
commands_printf("mem");
commands_printf(" Show memory usage");
commands_printf("threads");
commands_printf(" List all threads");
commands_printf("fault");
commands_printf(" Prints the current fault code");
commands_printf("faults");
commands_printf(" Prints all stored fault codes and conditions when they arrived");
commands_printf("rpm");
commands_printf(" Prints the current electrical RPM");
commands_printf("tacho");
commands_printf(" Prints tachometer value");
commands_printf("tim");
commands_printf(" Prints tim1 and tim8 settings");
commands_printf("volt");
commands_printf(" Prints different voltages");
commands_printf("param_detect [current] [min_rpm] [low_duty]");
commands_printf(" Spin up the motor in COMM_MODE_DELAY and compute its parameters.");
commands_printf(" This test should be performed without load on the motor.");
commands_printf(" Example: param_detect 5.0 600 0.06");
commands_printf("rpm_dep");
commands_printf(" Prints some rpm-dep values");
commands_printf("can_devs");
commands_printf(" Prints all CAN devices seen on the bus the past second");
commands_printf("foc_encoder_detect [current]");
commands_printf(" Run the motor at 1Hz on open loop and compute encoder settings");
commands_printf("measure_res [current]");
commands_printf(" Lock the motor with a current and calculate its resistance");
commands_printf("measure_ind [duty]");
commands_printf(" Send short voltage pulses, measure the current and calculate the motor inductance");
commands_printf("measure_linkage [current] [duty] [min_rpm] [motor_res]");
commands_printf(" Run the motor in BLDC delay mode and measure the flux linkage");
commands_printf(" example measure_linkage 5 0.5 700 0.076");
commands_printf(" tip: measure the resistance with measure_res first");
commands_printf("measure_res_ind");
commands_printf(" Measure the motor resistance and inductance with an incremental adaptive algorithm.");
commands_printf("measure_linkage_foc [duty]");
commands_printf(" Run the motor with FOC and measure the flux linkage.");
commands_printf("foc_state");
commands_printf(" Print some FOC state variables.\n");
} else {
commands_printf("Invalid command: %s\n"
"type help to list all available commands\n", argv[0]);
}
}
void terminal_process_string(char *str) {
enum { kMaxArgs = 64 };
int argc = 0;
char *argv[kMaxArgs];
#if MAIN_MODE == MAIN_MODE_CAR
static char buffer[256];
#endif
char *p2 = strtok(str, " ");
while (p2 && argc < kMaxArgs) {
argv[argc++] = p2;
p2 = strtok(0, " ");
}
if (argc == 0) {
commands_printf("No command received\n");
return;
}
if (strcmp(argv[0], "ping") == 0) {
commands_printf("pong\n");
} else if (strcmp(argv[0], "mem") == 0) {
size_t n, size;
n = chHeapStatus(NULL, &size);
commands_printf("core free memory : %u bytes", chCoreGetStatusX());
commands_printf("heap fragments : %u", n);
commands_printf("heap free total : %u bytes\n", size);
} else if (strcmp(argv[0], "threads") == 0) {
thread_t *tp;
static const char *states[] = {CH_STATE_NAMES};
commands_printf(" addr stack prio refs state name time ");
commands_printf("-------------------------------------------------------------");
tp = chRegFirstThread();
do {
commands_printf("%.8lx %.8lx %4lu %4lu %9s %14s %lu",
(uint32_t)tp, (uint32_t)tp->p_ctx.r13,
(uint32_t)tp->p_prio, (uint32_t)(tp->p_refs - 1),
states[tp->p_state], tp->p_name, (uint32_t)tp->p_time);
tp = chRegNextThread(tp);
} while (tp != NULL);
commands_printf(" ");
}
#if MAIN_MODE == MAIN_MODE_CAR
else if (strcmp(argv[0], "vesc") == 0) {
buffer[0] = '\0';
int ind = 0;
for (int i = 1;i < argc;i++) {
sprintf(buffer + ind, " %s", argv[i]);
ind += strlen(argv[i]) + 1;
}
bldc_interface_terminal_cmd(buffer);
}
#if RADAR_EN
else if (strcmp(argv[0], "radar_sample") == 0) {
commands_printf("Sampling radar...");
radar_setup_measurement_default();
radar_sample();
} else if (strcmp(argv[0], "radar_cmd") == 0) {
buffer[0] = '\0';
int ind = 0;
for (int i = 1;i < argc;i++) {
if (i == 1) {
sprintf(buffer + ind, "%s", argv[i]);
ind += strlen(argv[i]);
} else {
sprintf(buffer + ind, " %s", argv[i]);
ind += strlen(argv[i]) + 1;
}
}
radar_cmd(buffer);
} else if (strcmp(argv[0], "radar_reset") == 0) {
commands_printf("Resetting radar...");
radar_reset_setup();
}
#endif
#endif
else if (strcmp(argv[0], "reset_att") == 0) {
pos_reset_attitude();
} else if (strcmp(argv[0], "reset_enu") == 0) {
pos_reset_enu_ref();
} else if (strcmp(argv[0], "cc1120_state") == 0) {
commands_printf("%s\n", cc1120_state_name());
} else if (strcmp(argv[0], "cc1120_update_rf") == 0) {
if (argc != 2) {
commands_printf("Invalid number of arguments\n");
} else {
int set = -1;
sscanf(argv[1], "%d", &set);
if (set < 0) {
commands_printf("Invalid argument\n");
} else {
cc1120_update_rf(set);
commands_printf("Done\n");
}
}
} else if (strcmp(argv[0], "dw_range") == 0) {
if (argc != 2) {
commands_printf("Invalid number of arguments\n");
} else {
int dest = -1;
sscanf(argv[1], "%d", &dest);
if (dest < 0 || dest > 254) {
commands_printf("Invalid argument\n");
} else {
comm_can_set_range_func(range_callback);
comm_can_dw_range(CAN_DW_ID_ANY, dest, 5);
}
}
} else if (strcmp(argv[0], "zero_gyro") == 0) {
led_write(LED_RED, 1);
mpu9150_sample_gyro_offsets(100);
led_write(LED_RED, 0);
}
// The help command
else if (strcmp(argv[0], "help") == 0) {
commands_printf("Valid commands are:");
commands_printf("help");
commands_printf(" Show this help");
commands_printf("ping");
commands_printf(" Print pong here to see if the reply works");
commands_printf("mem");
commands_printf(" Show memory usage");
commands_printf("threads");
commands_printf(" List all threads");
#if MAIN_MODE == MAIN_MODE_CAR
commands_printf("vesc");
commands_printf(" Forward command to VESC");
#if RADAR_EN
commands_printf("radar_sample");
commands_printf(" Start radar sampling");
commands_printf("radar_cmd");
commands_printf(" Forward command to radar");
commands_printf("radar_reset");
commands_printf(" Reset and setup the radar");
#endif
#endif
commands_printf("reset_att");
commands_printf(" Re-initialize the attitude estimation");
commands_printf("reset_enu");
commands_printf(" Re-initialize the ENU reference on the next GNSS sample");
commands_printf("cc1120_state");
commands_printf(" Print the state of the CC1120");
commands_printf("cc1120_update_rf [rf_setting]");
commands_printf(" Set one of the cc1120 RF settings");
int ind = 0;
commands_printf(" %d: %s", ind++, "CC1120_SET_434_0M_1_2K_2FSK_BW25K_4K");
commands_printf(" %d: %s", ind++, "CC1120_SET_434_0M_1_2K_2FSK_BW50K_20K");
commands_printf(" %d: %s", ind++, "CC1120_SET_434_0M_1_2K_2FSK_BW10K_4K");
commands_printf(" %d: %s", ind++, "CC1120_SET_434_0M_50K_2GFSK_BW100K_25K");
commands_printf(" %d: %s", ind++, "CC1120_SET_434_0M_100K_4FSK_BW100K_25K");
commands_printf(" %d: %s", ind++, "CC1120_SET_434_0M_4_8K_2FSK_BW40K_9K");
commands_printf(" %d: %s", ind++, "CC1120_SET_434_0M_4_8K_2FSK_BW50K_14K");
commands_printf(" %d: %s", ind++, "CC1120_SET_434_0M_4_8K_2FSK_BW100K_39K");
commands_printf(" %d: %s", ind++, "CC1120_SET_434_0M_9_6K_2FSK_BW50K_12K");
commands_printf(" %d: %s", ind++, "CC1120_SET_452_0M_9_6K_2GFSK_BW33K_2_4K");
commands_printf(" %d: %s", ind++, "CC1120_SET_452_0M_9_6K_2GFSK_BW50K_2_4K");
commands_printf("dw_range [dest]");
commands_printf(" Measure the distance to DW module [dest] with ultra wideband.");
commands_printf("zero_gyro");
commands_printf(" Zero the gyro bias. Note: The PCB must be completely still when running this command.");
for (int i = 0;i < callback_write;i++) {
if (callbacks[i].arg_names) {
commands_printf("%s %s", callbacks[i].command, callbacks[i].arg_names);
} else {
commands_printf(callbacks[i].command);
}
if (callbacks[i].help) {
commands_printf(" %s", callbacks[i].help);
} else {
commands_printf(" There is no help available for this command.");
}
}
commands_printf(" ");
} else {
bool found = false;
for (int i = 0;i < callback_write;i++) {
if (strcmp(argv[0], callbacks[i].command) == 0) {
callbacks[i].cbf(argc, (const char**)argv);
found = true;
break;
}
}
if (!found) {
commands_printf("Invalid command: %s\n"
"type help to list all available commands\n", argv[0]);
}
}
}
void terminal_process_string(char *str) {
enum { kMaxArgs = 64 };
int argc = 0;
char *argv[kMaxArgs];
static char buffer[256];
char *p2 = strtok(str, " ");
while (p2 && argc < kMaxArgs) {
argv[argc++] = p2;
p2 = strtok(0, " ");
}
if (argc == 0) {
comm_print("No command received\n");
return;
}
if (strcmp(argv[0], "ping") == 0) {
comm_print("pong\n");
} else if (strcmp(argv[0], "stop") == 0) {
mcpwm_set_duty(0);
comm_print("Motor stopped\n");
} else if (strcmp(argv[0], "last_adc_duration") == 0) {
sprintf(buffer, "Latest ADC duration: %.4f ms", (double)(mcpwm_get_last_adc_isr_duration() * 1000.0));
comm_print(buffer);
sprintf(buffer, "Latest injected ADC duration: %.4f ms", (double)(mcpwm_get_last_inj_adc_isr_duration() * 1000.0));
comm_print(buffer);
sprintf(buffer, "Latest main ADC duration: %.4f ms\n", (double)(main_get_last_adc_isr_duration() * 1000.0));
comm_print(buffer);
} else if (strcmp(argv[0], "kv") == 0) {
sprintf(buffer, "Calculated KV: %.2f rpm/volt\n", (double)mcpwm_get_kv_filtered());
comm_print(buffer);
} else if (strcmp(argv[0], "mem") == 0) {
size_t n, size;
n = chHeapStatus(NULL, &size);
sprintf(buffer, "core free memory : %u bytes", chCoreStatus());
comm_print(buffer);
sprintf(buffer, "heap fragments : %u", n);
comm_print(buffer);
sprintf(buffer, "heap free total : %u bytes\n", size);
comm_print(buffer);
} else if (strcmp(argv[0], "threads") == 0) {
Thread *tp;
static const char *states[] = {THD_STATE_NAMES};
comm_print(" addr stack prio refs state name time ");
comm_print("-------------------------------------------------------------");
tp = chRegFirstThread();
do {
sprintf(buffer, "%.8lx %.8lx %4lu %4lu %9s %14s %lu",
(uint32_t)tp, (uint32_t)tp->p_ctx.r13,
(uint32_t)tp->p_prio, (uint32_t)(tp->p_refs - 1),
states[tp->p_state], tp->p_name, (uint32_t)tp->p_time);
comm_print(buffer);
tp = chRegNextThread(tp);
} while (tp != NULL);
comm_print("");
} else if (strcmp(argv[0], "fault") == 0) {
comm_print_fault_code(mcpwm_get_fault());
} else if (strcmp(argv[0], "rpm") == 0) {
sprintf(buffer, "Electrical RPM: %.2f rpm\n", (double)mcpwm_get_rpm());
comm_print(buffer);
} else if (strcmp(argv[0], "tacho") == 0) {
sprintf(buffer, "Tachometer counts: %i\n", mcpwm_get_tachometer_value(0));
comm_print(buffer);
} else if (strcmp(argv[0], "tim") == 0) {
TIM_Cmd(TIM1, DISABLE);
int t1_cnt = TIM1->CNT;
int t8_cnt = TIM8->CNT;
int duty = TIM1->CCR1;
int top = TIM1->ARR;
int voltage_samp = TIM8->CCR1;
int current1_samp = TIM1->CCR4;
int current2_samp = TIM8->CCR2;
TIM_Cmd(TIM1, ENABLE);
sprintf(buffer, "Tim1 CNT: %i", t1_cnt);
comm_print(buffer);
sprintf(buffer, "Tim8 CNT: %u", t8_cnt);
comm_print(buffer);
sprintf(buffer, "Duty cycle: %u", duty);
comm_print(buffer);
sprintf(buffer, "Top: %u", top);
comm_print(buffer);
sprintf(buffer, "Voltage sample: %u", voltage_samp);
comm_print(buffer);
sprintf(buffer, "Current 1 sample: %u", current1_samp);
comm_print(buffer);
sprintf(buffer, "Current 2 sample: %u\n", current2_samp);
comm_print(buffer);
} else if (strcmp(argv[0], "help") == 0) {
comm_print("Valid commands are:");
comm_print("help");
comm_print(" Show this help");
comm_print("ping");
comm_print(" Print pong here to see if the reply works");
comm_print("stop");
comm_print(" Stop the motor");
comm_print("last_adc_duration");
comm_print(" The time the latest ADC interrupt consumed");
comm_print("kv");
comm_print(" The calculated kv of the motor");
comm_print("mem");
comm_print(" Show memory usage");
comm_print("threads");
comm_print(" List all threads");
comm_print("fault");
comm_print(" Prints the current fault code");
comm_print("rpm");
comm_print(" Prints the current electrical RPM");
comm_print("tacho");
comm_print(" Prints tachometer value");
comm_print("tim");
comm_print(" Prints tim1 and tim8 settings\n");
} else {
sprintf(buffer, "Invalid command: %s\n"
"type help to list all available commands\n", argv[0]);
comm_print(buffer);
}
}
void terminal_process_string(char *str) {
enum { kMaxArgs = 64 };
int argc = 0;
char *argv[kMaxArgs];
char *p2 = strtok(str, " ");
while (p2 && argc < kMaxArgs) {
argv[argc++] = p2;
p2 = strtok(0, " ");
}
if (argc == 0) {
comm_printf("No command received\n");
return;
}
if (strcmp(argv[0], "ping") == 0) {
comm_printf("pong\n");
} else if (strcmp(argv[0], "stop") == 0) {
mcpwm_set_duty(0);
comm_printf("Motor stopped\n");
} else if (strcmp(argv[0], "last_adc_duration") == 0) {
comm_printf("Latest ADC duration: %.4f ms", (double)(mcpwm_get_last_adc_isr_duration() * 1000.0));
comm_printf("Latest injected ADC duration: %.4f ms", (double)(mcpwm_get_last_inj_adc_isr_duration() * 1000.0));
comm_printf("Latest main ADC duration: %.4f ms\n", (double)(main_get_last_adc_isr_duration() * 1000.0));
} else if (strcmp(argv[0], "kv") == 0) {
comm_printf("Calculated KV: %.2f rpm/volt\n", (double)mcpwm_get_kv_filtered());
} else if (strcmp(argv[0], "mem") == 0) {
size_t n, size;
n = chHeapStatus(NULL, &size);
comm_printf("core free memory : %u bytes", chCoreStatus());
comm_printf("heap fragments : %u", n);
comm_printf("heap free total : %u bytes\n", size);
} else if (strcmp(argv[0], "threads") == 0) {
Thread *tp;
static const char *states[] = {THD_STATE_NAMES};
comm_printf(" addr stack prio refs state name time ");
comm_printf("-------------------------------------------------------------");
tp = chRegFirstThread();
do {
comm_printf("%.8lx %.8lx %4lu %4lu %9s %14s %lu",
(uint32_t)tp, (uint32_t)tp->p_ctx.r13,
(uint32_t)tp->p_prio, (uint32_t)(tp->p_refs - 1),
states[tp->p_state], tp->p_name, (uint32_t)tp->p_time);
tp = chRegNextThread(tp);
} while (tp != NULL);
comm_printf("");
} else if (strcmp(argv[0], "fault") == 0) {
comm_print_fault_code(mcpwm_get_fault());
} else if (strcmp(argv[0], "rpm") == 0) {
comm_printf("Electrical RPM: %.2f rpm\n", (double)mcpwm_get_rpm());
} else if (strcmp(argv[0], "tacho") == 0) {
comm_printf("Tachometer counts: %i\n", mcpwm_get_tachometer_value(0));
} else if (strcmp(argv[0], "tim") == 0) {
TIM_Cmd(TIM_PWM, DISABLE);
int t_pwm_cnt = TIM_PWM->CNT;
int t_adc_cnt = TIM_ADC->CNT;
int duty = TIM_PWM->CCR1;
int top = TIM_PWM->ARR;
int voltage_samp = TIM_ADC->CCR1;
int current1_samp = TIM_PWM->CCR4;
int current2_samp = TIM_ADC->CCR4;
TIM_Cmd(TIM_PWM, ENABLE);
comm_printf("TIM_PWM CNT: %i", t_pwm_cnt);
comm_printf("TIM_ADC CNT: %u", t_adc_cnt);
comm_printf("Duty cycle: %u", duty);
comm_printf("Top: %u", top);
comm_printf("Voltage sample: %u", voltage_samp);
comm_printf("Current 1 sample: %u", current1_samp);
comm_printf("Current 2 sample: %u\n", current2_samp);
} else if (strcmp(argv[0], "volt") == 0) {
comm_printf("Input voltage: %.2f\n", (double)GET_INPUT_VOLTAGE());
} else if (strcmp(argv[0], "reset_drv") == 0) {
comm_printf("reset driver\n");
mcpwm_reset_driver();
}
// Setters
else if (strcmp(argv[0], "set_hall_table") == 0) {
if (argc == 4) {
int dir = -1;
int fwd_add = -1;
int rev_add = -1;
sscanf(argv[1], "%i", &dir);
sscanf(argv[2], "%i", &fwd_add);
sscanf(argv[3], "%i", &rev_add);
if (dir >= 0 && fwd_add >= 0 && rev_add >= 0) {
mcpwm_init_hall_table(dir, fwd_add, rev_add);
comm_printf("New hall sensor dir: %i fwd_add %i rev_add %i\n",
dir, fwd_add, rev_add);
} else {
comm_printf("Invalid argument(s).\n");
}
} else {
comm_printf("This command requires three arguments.\n");
}
}
// The help command
else if (strcmp(argv[0], "help") == 0) {
comm_printf("Valid commands are:");
comm_printf("help");
comm_printf(" Show this help");
comm_printf("ping");
comm_printf(" Print pong here to see if the reply works");
comm_printf("stop");
comm_printf(" Stop the motor");
comm_printf("last_adc_duration");
comm_printf(" The time the latest ADC interrupt consumed");
comm_printf("kv");
comm_printf(" The calculated kv of the motor");
comm_printf("mem");
comm_printf(" Show memory usage");
comm_printf("threads");
comm_printf(" List all threads");
comm_printf("fault");
comm_printf(" Prints the current fault code");
comm_printf("rpm");
comm_printf(" Prints the current electrical RPM");
comm_printf("tacho");
comm_printf(" Prints tachometer value");
comm_printf("tim");
comm_printf(" Prints TIM_PWM and TIM_ADC settings");
comm_printf("reset_drv");
comm_printf(" Short pulse on EN_GATE to reset latched driver fault");
comm_printf("set_hall_table [dir] [fwd_add] [rev_add]");
comm_printf(" Update the hall sensor lookup table");
comm_printf("volt");
comm_printf(" Prints different voltages\n");
} else {
comm_printf("Invalid command: %s\n"
"type help to list all available commands\n", argv[0]);
}
}
