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]); } }