PES_4_Spleisser / Mbed 2 deprecated SpleisserProgramm_V9

Update

Dependencies:   mbed mbed-rtos X_NUCLEO_IHM02A1

PWM.cpp@42:0aaa3b282b6e, 2019-05-16 (annotated)

Committer:
scherfa2
Date:
Thu May 16 20:10:32 2019 +0000
Revision:
42:0aaa3b282b6e
Parent:
39:6cc9a40bc8a6 
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 39:6cc9a40bc8a6 54 Cutter_1.period(1/(float)CUTTER_FRQ_1);
hagenrap 39:6cc9a40bc8a6 55 Cutter_2.period(1/(float)CUTTER_FRQ_2);
hagenrap 39:6cc9a40bc8a6 56
hagenrap 35:758191d5c6e1 57 for(int i = repeats; i>0; i--)
hagenrap 35:758191d5c6e1 58 {
hagenrap 35:758191d5c6e1 59 Cutter_1 = (float)CUTTER_DUTY/100;
hagenrap 35:758191d5c6e1 60 Cutter_2 = (float)CUTTER_DUTY/100;
hagenrap 35:758191d5c6e1 61 Thread::wait(arc_on_time);
hagenrap 35:758191d5c6e1 62 Cutter_1 = 0.0;
hagenrap 35:758191d5c6e1 63 Cutter_2 = 0.0;
hagenrap 35:758191d5c6e1 64 Thread::wait(arc_off_time);
hagenrap 35:758191d5c6e1 65 }
hagenrap 35:758191d5c6e1 66 Cutter_1 = 0.0;
hagenrap 35:758191d5c6e1 67 Cutter_2 = 0.0;
hagenrap 35:758191d5c6e1 68 }
hagenrap 35:758191d5c6e1 69 /* ---------------------------- END ----------------------------------------- */
hagenrap 35:758191d5c6e1 70
hagenrap 35:758191d5c6e1 71
hagenrap 35:758191d5c6e1 72
hagenrap 35:758191d5c6e1 73 /* ---------------------------- SPLEISSER ----------------------------------- */
hagenrap 35:758191d5c6e1 74 void Init_Spleisser()
hagenrap 35:758191d5c6e1 75 {
hagenrap 35:758191d5c6e1 76 Spleisser_1.period(1/(float)SPLEISSER_FRQ_1);
scherfa2 38:3776ee18e56f 77 Spleisser_1 = 0.0;
hagenrap 35:758191d5c6e1 78
hagenrap 35:758191d5c6e1 79 Spleisser_2.period(1/(float)SPLEISSER_FRQ_2);
scherfa2 38:3776ee18e56f 80 Spleisser_2 = 0.0;
hagenrap 35:758191d5c6e1 81 }
hagenrap 37:a74d377d8f74 82
hagenrap 35:758191d5c6e1 83 void Set_Spleisser(int arc_on_time, int arc_off_time, int repeats)
hagenrap 35:758191d5c6e1 84 {
hagenrap 39:6cc9a40bc8a6 85 Spleisser_1.period(1/(float)SPLEISSER_FRQ_1);
hagenrap 39:6cc9a40bc8a6 86 Spleisser_2.period(1/(float)SPLEISSER_FRQ_2);
hagenrap 39:6cc9a40bc8a6 87
hagenrap 35:758191d5c6e1 88 for(int i = repeats; i>0; i--)
hagenrap 35:758191d5c6e1 89 {
hagenrap 35:758191d5c6e1 90 Spleisser_1 = (float)SPLEISSER_DUTY/100;
hagenrap 35:758191d5c6e1 91 Spleisser_2 = (float)SPLEISSER_DUTY/100;
hagenrap 35:758191d5c6e1 92 Thread::wait(arc_on_time);
hagenrap 35:758191d5c6e1 93 Spleisser_1 = 0.0;
hagenrap 35:758191d5c6e1 94 Spleisser_2 = 0.0;
hagenrap 35:758191d5c6e1 95 Thread::wait(arc_off_time);
hagenrap 35:758191d5c6e1 96 }
hagenrap 35:758191d5c6e1 97 Spleisser_1 = 0.0;
hagenrap 35:758191d5c6e1 98 Spleisser_2 = 0.0;
hagenrap 35:758191d5c6e1 99 }
hagenrap 35:758191d5c6e1 100 /* ---------------------------- END ----------------------------------------- */