Buttons update
Dependencies: mbed mbed-rtos X_NUCLEO_IHM02A1
PWM.cpp@37:a74d377d8f74, 2019-05-10 (annotated)
- Committer:
- hagenrap
- Date:
- Fri May 10 17:31:36 2019 +0000
- Revision:
- 37:a74d377d8f74
- Parent:
- 36:ba2e7eddbafa
- Child:
- 38:3776ee18e56f
spleisser probleme;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
hagenrap | 35:758191d5c6e1 | 1 | #include "SETUP.h" |
hagenrap | 35:758191d5c6e1 | 2 | |
hagenrap | 35:758191d5c6e1 | 3 | extern PwmOut Servo; |
hagenrap | 35:758191d5c6e1 | 4 | extern PwmOut Cutter_1; |
hagenrap | 35:758191d5c6e1 | 5 | extern PwmOut Cutter_2; |
hagenrap | 35:758191d5c6e1 | 6 | extern PwmOut Spleisser_1; |
hagenrap | 35:758191d5c6e1 | 7 | extern PwmOut Spleisser_2; |
hagenrap | 35:758191d5c6e1 | 8 | |
hagenrap | 35:758191d5c6e1 | 9 | float duty1 = (GOOD_FIL*0.2666666+22.5)/100; |
hagenrap | 35:758191d5c6e1 | 10 | float duty2 = (BAD_FIL*0.2666666+22.5)/100; |
hagenrap | 35:758191d5c6e1 | 11 | |
hagenrap | 35:758191d5c6e1 | 12 | |
hagenrap | 35:758191d5c6e1 | 13 | /* ---------------------------- SERVO --------------------------------------- */ |
hagenrap | 35:758191d5c6e1 | 14 | void Init_Servo() |
hagenrap | 35:758191d5c6e1 | 15 | { |
hagenrap | 35:758191d5c6e1 | 16 | Servo.period(1/(float)SERVO_FR); |
hagenrap | 35:758191d5c6e1 | 17 | Servo = 0.0; |
hagenrap | 35:758191d5c6e1 | 18 | } |
hagenrap | 35:758191d5c6e1 | 19 | |
hagenrap | 35:758191d5c6e1 | 20 | void Set_Servo_Good_Fil() |
hagenrap | 35:758191d5c6e1 | 21 | { |
hagenrap | 35:758191d5c6e1 | 22 | Servo.period(1/(float)SERVO_FR); |
hagenrap | 35:758191d5c6e1 | 23 | Servo = duty1; |
hagenrap | 35:758191d5c6e1 | 24 | } |
hagenrap | 35:758191d5c6e1 | 25 | |
hagenrap | 35:758191d5c6e1 | 26 | void Set_Servo_Bad_Fil() |
hagenrap | 35:758191d5c6e1 | 27 | { |
hagenrap | 35:758191d5c6e1 | 28 | Servo.period(1/(float)SERVO_FR); |
hagenrap | 35:758191d5c6e1 | 29 | Servo = duty2; |
hagenrap | 35:758191d5c6e1 | 30 | } |
hagenrap | 36:ba2e7eddbafa | 31 | void Servo_Off() |
hagenrap | 36:ba2e7eddbafa | 32 | { |
hagenrap | 36:ba2e7eddbafa | 33 | Thread::wait(250); |
hagenrap | 36:ba2e7eddbafa | 34 | Servo.period(1/(float)SERVO_FR); |
hagenrap | 36:ba2e7eddbafa | 35 | Servo = 0.0; |
hagenrap | 36:ba2e7eddbafa | 36 | } |
hagenrap | 36:ba2e7eddbafa | 37 | |
hagenrap | 35:758191d5c6e1 | 38 | /* ---------------------------- END ----------------------------------------- */ |
hagenrap | 35:758191d5c6e1 | 39 | |
hagenrap | 35:758191d5c6e1 | 40 | |
hagenrap | 35:758191d5c6e1 | 41 | |
hagenrap | 35:758191d5c6e1 | 42 | /* ---------------------------- CUTTER -------------------------------------- */ |
hagenrap | 35:758191d5c6e1 | 43 | void Init_Cutter() |
hagenrap | 35:758191d5c6e1 | 44 | { |
hagenrap | 35:758191d5c6e1 | 45 | Cutter_1.period(1/(float)CUTTER_FRQ_1); |
hagenrap | 37:a74d377d8f74 | 46 | Cutter_1 = 0.7; |
hagenrap | 35:758191d5c6e1 | 47 | |
hagenrap | 35:758191d5c6e1 | 48 | Cutter_2.period(1/(float)CUTTER_FRQ_2); |
hagenrap | 37:a74d377d8f74 | 49 | Cutter_2 = 0.7; |
hagenrap | 35:758191d5c6e1 | 50 | } |
hagenrap | 35:758191d5c6e1 | 51 | |
hagenrap | 35:758191d5c6e1 | 52 | void Set_Cutter(int arc_on_time, int arc_off_time, int repeats) |
hagenrap | 35:758191d5c6e1 | 53 | { |
hagenrap | 35:758191d5c6e1 | 54 | for(int i = repeats; i>0; i--) |
hagenrap | 35:758191d5c6e1 | 55 | { |
hagenrap | 35:758191d5c6e1 | 56 | Cutter_1 = (float)CUTTER_DUTY/100; |
hagenrap | 35:758191d5c6e1 | 57 | Cutter_2 = (float)CUTTER_DUTY/100; |
hagenrap | 35:758191d5c6e1 | 58 | Thread::wait(arc_on_time); |
hagenrap | 35:758191d5c6e1 | 59 | Cutter_1 = 0.0; |
hagenrap | 35:758191d5c6e1 | 60 | Cutter_2 = 0.0; |
hagenrap | 35:758191d5c6e1 | 61 | Thread::wait(arc_off_time); |
hagenrap | 35:758191d5c6e1 | 62 | } |
hagenrap | 35:758191d5c6e1 | 63 | Cutter_1 = 0.0; |
hagenrap | 35:758191d5c6e1 | 64 | Cutter_2 = 0.0; |
hagenrap | 35:758191d5c6e1 | 65 | } |
hagenrap | 35:758191d5c6e1 | 66 | /* ---------------------------- END ----------------------------------------- */ |
hagenrap | 35:758191d5c6e1 | 67 | |
hagenrap | 35:758191d5c6e1 | 68 | |
hagenrap | 35:758191d5c6e1 | 69 | |
hagenrap | 35:758191d5c6e1 | 70 | /* ---------------------------- SPLEISSER ----------------------------------- */ |
hagenrap | 35:758191d5c6e1 | 71 | void Init_Spleisser() |
hagenrap | 35:758191d5c6e1 | 72 | { |
hagenrap | 35:758191d5c6e1 | 73 | Spleisser_1.period(1/(float)SPLEISSER_FRQ_1); |
hagenrap | 37:a74d377d8f74 | 74 | Spleisser_1 = 0.7; |
hagenrap | 35:758191d5c6e1 | 75 | |
hagenrap | 35:758191d5c6e1 | 76 | Spleisser_2.period(1/(float)SPLEISSER_FRQ_2); |
hagenrap | 37:a74d377d8f74 | 77 | Spleisser_2 = 0.7; |
hagenrap | 35:758191d5c6e1 | 78 | } |
hagenrap | 37:a74d377d8f74 | 79 | |
hagenrap | 35:758191d5c6e1 | 80 | void Set_Spleisser(int arc_on_time, int arc_off_time, int repeats) |
hagenrap | 35:758191d5c6e1 | 81 | { |
hagenrap | 35:758191d5c6e1 | 82 | for(int i = repeats; i>0; i--) |
hagenrap | 35:758191d5c6e1 | 83 | { |
hagenrap | 35:758191d5c6e1 | 84 | Spleisser_1 = (float)SPLEISSER_DUTY/100; |
hagenrap | 35:758191d5c6e1 | 85 | Spleisser_2 = (float)SPLEISSER_DUTY/100; |
hagenrap | 35:758191d5c6e1 | 86 | Thread::wait(arc_on_time); |
hagenrap | 35:758191d5c6e1 | 87 | Spleisser_1 = 0.0; |
hagenrap | 35:758191d5c6e1 | 88 | Spleisser_2 = 0.0; |
hagenrap | 35:758191d5c6e1 | 89 | Thread::wait(arc_off_time); |
hagenrap | 35:758191d5c6e1 | 90 | } |
hagenrap | 35:758191d5c6e1 | 91 | Spleisser_1 = 0.0; |
hagenrap | 35:758191d5c6e1 | 92 | Spleisser_2 = 0.0; |
hagenrap | 35:758191d5c6e1 | 93 | } |
hagenrap | 35:758191d5c6e1 | 94 | /* ---------------------------- END ----------------------------------------- */ |