PES_4_Spleisser / Mbed 2 deprecated SpleisserProgramm_V9

Update

Dependencies:   mbed mbed-rtos X_NUCLEO_IHM02A1

PWM.cpp@38:3776ee18e56f, 2019-05-13 (annotated)

Committer:
scherfa2
Date:
Mon May 13 10:11:48 2019 +0000
Revision:
38:3776ee18e56f
Parent:
37:a74d377d8f74
Child:
39:6cc9a40bc8a6
Buttons update

Who changed what in which revision?

UserRevisionLine numberNew 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);
scherfa2 38:3776ee18e56f 46 Cutter_1 = 0.0;
hagenrap 35:758191d5c6e1 47
hagenrap 35:758191d5c6e1 48 Cutter_2.period(1/(float)CUTTER_FRQ_2);
scherfa2 38:3776ee18e56f 49 Cutter_2 = 0.0;
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);
scherfa2 38:3776ee18e56f 74 Spleisser_1 = 0.0;
hagenrap 35:758191d5c6e1 75
hagenrap 35:758191d5c6e1 76 Spleisser_2.period(1/(float)SPLEISSER_FRQ_2);
scherfa2 38:3776ee18e56f 77 Spleisser_2 = 0.0;
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 ----------------------------------------- */