PES_4_Spleisser / Mbed 2 deprecated SpleisserProgramm_V7

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?

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 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 ----------------------------------------- */