Update
Dependencies: mbed mbed-rtos X_NUCLEO_IHM02A1
PWM.cpp@35:758191d5c6e1, 2019-05-05 (annotated)
- Committer:
- hagenrap
- Date:
- Sun May 05 16:18:20 2019 +0000
- Revision:
- 35:758191d5c6e1
- Child:
- 36:ba2e7eddbafa
V3; ;
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 | 35:758191d5c6e1 | 31 | /* ---------------------------- END ----------------------------------------- */ |
hagenrap | 35:758191d5c6e1 | 32 | |
hagenrap | 35:758191d5c6e1 | 33 | |
hagenrap | 35:758191d5c6e1 | 34 | |
hagenrap | 35:758191d5c6e1 | 35 | /* ---------------------------- CUTTER -------------------------------------- */ |
hagenrap | 35:758191d5c6e1 | 36 | void Init_Cutter() |
hagenrap | 35:758191d5c6e1 | 37 | { |
hagenrap | 35:758191d5c6e1 | 38 | Cutter_1.period(1/(float)CUTTER_FRQ_1); |
hagenrap | 35:758191d5c6e1 | 39 | Cutter_1 = 0.0; |
hagenrap | 35:758191d5c6e1 | 40 | |
hagenrap | 35:758191d5c6e1 | 41 | Cutter_2.period(1/(float)CUTTER_FRQ_2); |
hagenrap | 35:758191d5c6e1 | 42 | Cutter_2 = 0.0; |
hagenrap | 35:758191d5c6e1 | 43 | } |
hagenrap | 35:758191d5c6e1 | 44 | |
hagenrap | 35:758191d5c6e1 | 45 | void Set_Cutter(int arc_on_time, int arc_off_time, int repeats) |
hagenrap | 35:758191d5c6e1 | 46 | { |
hagenrap | 35:758191d5c6e1 | 47 | for(int i = repeats; i>0; i--) |
hagenrap | 35:758191d5c6e1 | 48 | { |
hagenrap | 35:758191d5c6e1 | 49 | Cutter_1 = (float)CUTTER_DUTY/100; |
hagenrap | 35:758191d5c6e1 | 50 | Cutter_2 = (float)CUTTER_DUTY/100; |
hagenrap | 35:758191d5c6e1 | 51 | Thread::wait(arc_on_time); |
hagenrap | 35:758191d5c6e1 | 52 | Cutter_1 = 0.0; |
hagenrap | 35:758191d5c6e1 | 53 | Cutter_2 = 0.0; |
hagenrap | 35:758191d5c6e1 | 54 | Thread::wait(arc_off_time); |
hagenrap | 35:758191d5c6e1 | 55 | } |
hagenrap | 35:758191d5c6e1 | 56 | Cutter_1 = 0.0; |
hagenrap | 35:758191d5c6e1 | 57 | Cutter_2 = 0.0; |
hagenrap | 35:758191d5c6e1 | 58 | } |
hagenrap | 35:758191d5c6e1 | 59 | /* ---------------------------- END ----------------------------------------- */ |
hagenrap | 35:758191d5c6e1 | 60 | |
hagenrap | 35:758191d5c6e1 | 61 | |
hagenrap | 35:758191d5c6e1 | 62 | |
hagenrap | 35:758191d5c6e1 | 63 | /* ---------------------------- SPLEISSER ----------------------------------- */ |
hagenrap | 35:758191d5c6e1 | 64 | void Init_Spleisser() |
hagenrap | 35:758191d5c6e1 | 65 | { |
hagenrap | 35:758191d5c6e1 | 66 | Spleisser_1.period(1/(float)SPLEISSER_FRQ_1); |
hagenrap | 35:758191d5c6e1 | 67 | Spleisser_1 = 0.0; |
hagenrap | 35:758191d5c6e1 | 68 | |
hagenrap | 35:758191d5c6e1 | 69 | Spleisser_2.period(1/(float)SPLEISSER_FRQ_2); |
hagenrap | 35:758191d5c6e1 | 70 | Spleisser_2 = 0.0; |
hagenrap | 35:758191d5c6e1 | 71 | } |
hagenrap | 35:758191d5c6e1 | 72 | |
hagenrap | 35:758191d5c6e1 | 73 | void Set_Spleisser(int arc_on_time, int arc_off_time, int repeats) |
hagenrap | 35:758191d5c6e1 | 74 | { |
hagenrap | 35:758191d5c6e1 | 75 | for(int i = repeats; i>0; i--) |
hagenrap | 35:758191d5c6e1 | 76 | { |
hagenrap | 35:758191d5c6e1 | 77 | Spleisser_1 = (float)SPLEISSER_DUTY/100; |
hagenrap | 35:758191d5c6e1 | 78 | Spleisser_2 = (float)SPLEISSER_DUTY/100; |
hagenrap | 35:758191d5c6e1 | 79 | Thread::wait(arc_on_time); |
hagenrap | 35:758191d5c6e1 | 80 | Spleisser_1 = 0.0; |
hagenrap | 35:758191d5c6e1 | 81 | Spleisser_2 = 0.0; |
hagenrap | 35:758191d5c6e1 | 82 | Thread::wait(arc_off_time); |
hagenrap | 35:758191d5c6e1 | 83 | } |
hagenrap | 35:758191d5c6e1 | 84 | Spleisser_1 = 0.0; |
hagenrap | 35:758191d5c6e1 | 85 | Spleisser_2 = 0.0; |
hagenrap | 35:758191d5c6e1 | 86 | } |
hagenrap | 35:758191d5c6e1 | 87 | /* ---------------------------- END ----------------------------------------- */ |