TUK Workshop
Dependencies: mbed lib_workshop_2019
main.cpp@9:f1dc5709a98d, 2019-10-24 (annotated)
- Committer:
- tuk4
- Date:
- Thu Oct 24 13:23:03 2019 +0000
- Revision:
- 9:f1dc5709a98d
- Parent:
- 8:c2d06715025f
changes TUK 24-10-2019
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
gvaquette | 0:0a75a79d6b77 | 1 | #include "mbed.h" |
gvaquette | 1:7a8764e627b5 | 2 | |
gvaquette | 0:0a75a79d6b77 | 3 | #include "console_output.h" |
gvaquette | 1:7a8764e627b5 | 4 | #include "test_us.h" |
gvaquette | 1:7a8764e627b5 | 5 | #include "test_compass.h" |
gvaquette | 2:8153195b1672 | 6 | #include "test_cny.h" |
gvaquette | 4:bf5caf4c0c88 | 7 | #include "test_motor.h" |
gvaquette | 1:7a8764e627b5 | 8 | |
gvaquette | 1:7a8764e627b5 | 9 | #include "pin_connexions.h" |
gvaquette | 1:7a8764e627b5 | 10 | |
tuk4 | 9:f1dc5709a98d | 11 | |
gvaquette | 0:0a75a79d6b77 | 12 | int main() { |
gvaquette | 1:7a8764e627b5 | 13 | e_test user_choice ; |
gvaquette | 0:0a75a79d6b77 | 14 | ft_print_test_menu(pc); |
gvaquette | 1:7a8764e627b5 | 15 | user_choice = ft_get_user_choice(pc); |
tuk4 | 9:f1dc5709a98d | 16 | blue_button_interupt.fall(&change_direction); |
tuk4 | 9:f1dc5709a98d | 17 | |
tuk4 | 9:f1dc5709a98d | 18 | |
gvaquette | 1:7a8764e627b5 | 19 | |
gvaquette | 4:bf5caf4c0c88 | 20 | |
gvaquette | 4:bf5caf4c0c88 | 21 | /* Main loop */ |
gvaquette | 1:7a8764e627b5 | 22 | while(1) |
gvaquette | 1:7a8764e627b5 | 23 | { |
tuk4 | 9:f1dc5709a98d | 24 | |
tuk4 | 9:f1dc5709a98d | 25 | wait_ms(250); |
tuk4 | 9:f1dc5709a98d | 26 | |
gvaquette | 4:bf5caf4c0c88 | 27 | /* Which component to test ? */ |
gvaquette | 1:7a8764e627b5 | 28 | switch (user_choice) |
gvaquette | 1:7a8764e627b5 | 29 | { |
gvaquette | 1:7a8764e627b5 | 30 | case ULTRASONIC : |
gvaquette | 1:7a8764e627b5 | 31 | do |
gvaquette | 1:7a8764e627b5 | 32 | { |
gvaquette | 1:7a8764e627b5 | 33 | ft_print_all_values_US(ultra_sonic, pc); |
gvaquette | 1:7a8764e627b5 | 34 | } while (!pc.readable()); |
gvaquette | 1:7a8764e627b5 | 35 | user_choice = ft_get_user_choice(pc); |
gvaquette | 1:7a8764e627b5 | 36 | pc.printf("\n"); |
gvaquette | 1:7a8764e627b5 | 37 | break; |
gvaquette | 1:7a8764e627b5 | 38 | |
gvaquette | 1:7a8764e627b5 | 39 | case COMPASS : |
gvaquette | 1:7a8764e627b5 | 40 | do |
gvaquette | 1:7a8764e627b5 | 41 | { |
gvaquette | 1:7a8764e627b5 | 42 | ft_print_compass_values(compass, pc); |
gvaquette | 1:7a8764e627b5 | 43 | } while (!pc.readable()); |
gvaquette | 1:7a8764e627b5 | 44 | pc.printf("\n"); |
gvaquette | 1:7a8764e627b5 | 45 | user_choice = ft_get_user_choice(pc); |
gvaquette | 1:7a8764e627b5 | 46 | break; |
gvaquette | 2:8153195b1672 | 47 | |
gvaquette | 2:8153195b1672 | 48 | case CNY70 : |
gvaquette | 2:8153195b1672 | 49 | do |
gvaquette | 2:8153195b1672 | 50 | { |
gvaquette | 2:8153195b1672 | 51 | pc.printf("\r CNY_1"); |
tuk4 | 9:f1dc5709a98d | 52 | ft_print_cny_analog_voltage(cny_1, pc); |
gvaquette | 2:8153195b1672 | 53 | pc.printf("\t CNY_2"); |
tuk4 | 9:f1dc5709a98d | 54 | ft_print_cny_analog_voltage(cny_2, pc); |
gvaquette | 2:8153195b1672 | 55 | pc.printf("\t CNY_3"); |
tuk4 | 9:f1dc5709a98d | 56 | ft_print_cny_analog_voltage(cny_3, pc); |
gvaquette | 2:8153195b1672 | 57 | } while (!pc.readable()); |
gvaquette | 2:8153195b1672 | 58 | pc.printf("\n"); |
gvaquette | 2:8153195b1672 | 59 | user_choice = ft_get_user_choice(pc); |
gvaquette | 2:8153195b1672 | 60 | break; |
gvaquette | 3:a0e37b8918ac | 61 | |
gvaquette | 3:a0e37b8918ac | 62 | case VBAT : |
gvaquette | 3:a0e37b8918ac | 63 | do |
gvaquette | 3:a0e37b8918ac | 64 | { |
gvaquette | 3:a0e37b8918ac | 65 | ft_print_to_be_imp(pc); |
gvaquette | 3:a0e37b8918ac | 66 | } while (!pc.readable()); |
gvaquette | 3:a0e37b8918ac | 67 | pc.printf("\n"); |
gvaquette | 3:a0e37b8918ac | 68 | user_choice = ft_get_user_choice(pc); |
gvaquette | 3:a0e37b8918ac | 69 | break; |
gvaquette | 3:a0e37b8918ac | 70 | |
gvaquette | 3:a0e37b8918ac | 71 | case LEFT_MOTOR : |
tuk4 | 9:f1dc5709a98d | 72 | ft_test_motor(Pwm_ML, DIR_1L, DIR_2L, pc); |
gvaquette | 3:a0e37b8918ac | 73 | user_choice = ft_get_user_choice(pc); |
gvaquette | 3:a0e37b8918ac | 74 | break; |
gvaquette | 3:a0e37b8918ac | 75 | |
gvaquette | 3:a0e37b8918ac | 76 | case RIGHT_MOTOR: |
tuk4 | 9:f1dc5709a98d | 77 | ft_test_motor(Pwm_MR, DIR_1R, DIR_2R, pc); |
gvaquette | 3:a0e37b8918ac | 78 | user_choice = ft_get_user_choice(pc); |
gvaquette | 3:a0e37b8918ac | 79 | break; |
gvaquette | 3:a0e37b8918ac | 80 | |
gvaquette | 2:8153195b1672 | 81 | |
gvaquette | 1:7a8764e627b5 | 82 | default : |
gvaquette | 1:7a8764e627b5 | 83 | ft_print_test_menu(pc); |
gvaquette | 1:7a8764e627b5 | 84 | user_choice = ft_get_user_choice(pc); |
gvaquette | 1:7a8764e627b5 | 85 | break; |
gvaquette | 1:7a8764e627b5 | 86 | } |
gvaquette | 1:7a8764e627b5 | 87 | } |
gvaquette | 1:7a8764e627b5 | 88 | |
gvaquette | 0:0a75a79d6b77 | 89 | } |