PES_4_Spleisser / Mbed 2 deprecated SpleisserProgramm_V9

Update

Dependencies:   mbed mbed-rtos X_NUCLEO_IHM02A1

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

Committer:
scherfa2
Date:
Thu May 16 20:10:32 2019 +0000
Revision:
42:0aaa3b282b6e
Parent:
41:1a2ba8849aa6 
Update

Who changed what in which revision?

UserRevisionLine numberNew contents of line
hagenrap 33:de144094bdd1 1 #include "SETUP.h"
scherfa2 30:e464b2bb2376 2
scherfa2 27:23bd03a6a6f6 3
hagenrap 36:ba2e7eddbafa 4 /*** BEISPIEL FÜR RAPHI
hagenrap 36:ba2e7eddbafa 5 if(evTasterStart == 1)
hagenrap 36:ba2e7eddbafa 6 {
hagenrap 36:ba2e7eddbafa 7
hagenrap 36:ba2e7eddbafa 8 entryEinlegenIn();
hagenrap 36:ba2e7eddbafa 9 StatusSOLO=SOLO_EinlegenIN;
hagenrap 36:ba2e7eddbafa 10 }*/
hagenrap 36:ba2e7eddbafa 11
hagenrap 36:ba2e7eddbafa 12 /*
hagenrap 36:ba2e7eddbafa 13 if (count < 2) {
hagenrap 36:ba2e7eddbafa 14 Set_Servo_Bad_Fil();
hagenrap 36:ba2e7eddbafa 15 count = count + 1;
hagenrap 36:ba2e7eddbafa 16 } else {
hagenrap 36:ba2e7eddbafa 17
hagenrap 36:ba2e7eddbafa 18 }
hagenrap 36:ba2e7eddbafa 19 */
hagenrap 36:ba2e7eddbafa 20
hagenrap 36:ba2e7eddbafa 21 /*
hagenrap 36:ba2e7eddbafa 22 Set_Servo_Bad_Fil();
hagenrap 36:ba2e7eddbafa 23 Thread::wait(1000);
hagenrap 36:ba2e7eddbafa 24 Set_Servo_Good_Fil();
hagenrap 36:ba2e7eddbafa 25 */
hagenrap 36:ba2e7eddbafa 26 /*
hagenrap 36:ba2e7eddbafa 27 if (buttonSTART_pressed == true)
hagenrap 36:ba2e7eddbafa 28 {
hagenrap 36:ba2e7eddbafa 29 printf("BUTTON_START\n\r");
hagenrap 36:ba2e7eddbafa 30 Thread::wait(1000);
hagenrap 36:ba2e7eddbafa 31 buttonSTART_pressed = false;
hagenrap 36:ba2e7eddbafa 32 }
hagenrap 36:ba2e7eddbafa 33 if (buttonAbbruch_pressed == true)
hagenrap 36:ba2e7eddbafa 34 {
hagenrap 36:ba2e7eddbafa 35 printf("BUTTON_ABBRUCH\n\r");
hagenrap 36:ba2e7eddbafa 36 Thread::wait(1000);
hagenrap 36:ba2e7eddbafa 37 buttonAbbruch_pressed = false;
hagenrap 36:ba2e7eddbafa 38 }
hagenrap 36:ba2e7eddbafa 39 */
hagenrap 36:ba2e7eddbafa 40 /*
hagenrap 36:ba2e7eddbafa 41 printf("SOLO\n\r");
hagenrap 36:ba2e7eddbafa 42 printf(" LS1 %d\n\r", LS_1.read());
hagenrap 36:ba2e7eddbafa 43 printf(" LS2 %d\n\r", LS_2.read());
hagenrap 36:ba2e7eddbafa 44 printf(" LS3 %d\n\r", LS_3.read());
hagenrap 36:ba2e7eddbafa 45 */
hagenrap 36:ba2e7eddbafa 46 /*
hagenrap 36:ba2e7eddbafa 47 printf("SOLO\n\r");
hagenrap 36:ba2e7eddbafa 48 motors[0]->run(StepperMotor::FWD, 500);
hagenrap 36:ba2e7eddbafa 49 Thread::wait(1000);
hagenrap 36:ba2e7eddbafa 50 */
hagenrap 36:ba2e7eddbafa 51
hagenrap 36:ba2e7eddbafa 52 /*
hagenrap 36:ba2e7eddbafa 53 motors[0]->run(StepperMotor::FWD, 500);
hagenrap 36:ba2e7eddbafa 54 */
hagenrap 36:ba2e7eddbafa 55 /*
hagenrap 36:ba2e7eddbafa 56 if(mybutton.read() == 0)
hagenrap 36:ba2e7eddbafa 57 {
hagenrap 36:ba2e7eddbafa 58 printf("Blitz\n\r");
hagenrap 36:ba2e7eddbafa 59 Set_Cutter(500, 2000, );
hagenrap 36:ba2e7eddbafa 60
hagenrap 36:ba2e7eddbafa 61 }
hagenrap 36:ba2e7eddbafa 62 */
hagenrap 36:ba2e7eddbafa 63
hagenrap 36:ba2e7eddbafa 64
hagenrap 36:ba2e7eddbafa 65
hagenrap 36:ba2e7eddbafa 66
hagenrap 36:ba2e7eddbafa 67
scherfa2 27:23bd03a6a6f6 68 int StatusSOLO=SOLO_DEFAULT;
hagenrap 39:6cc9a40bc8a6 69
hagenrap 35:758191d5c6e1 70 extern PwmOut Servo;
scherfa2 38:3776ee18e56f 71
scherfa2 38:3776ee18e56f 72 extern DigitalIn Button1;
scherfa2 38:3776ee18e56f 73 extern DigitalIn Button2;
scherfa2 38:3776ee18e56f 74
hagenrap 39:6cc9a40bc8a6 75 bool SOLO_Button1 = false;
hagenrap 39:6cc9a40bc8a6 76 bool SOLO_Button2 = false;
scherfa2 38:3776ee18e56f 77
scherfa2 29:b84d0cc8bac8 78
hagenrap 35:758191d5c6e1 79 extern DigitalIn LS_1;
hagenrap 35:758191d5c6e1 80 extern DigitalIn LS_2;
hagenrap 35:758191d5c6e1 81 extern DigitalIn LS_3;
hagenrap 35:758191d5c6e1 82
hagenrap 37:a74d377d8f74 83 extern L6470 **motors;
hagenrap 37:a74d377d8f74 84 extern L6470B **motors2;
hagenrap 37:a74d377d8f74 85
hagenrap 37:a74d377d8f74 86 extern XNucleoIHM02A1 *x_nucleo_ihm02a1_1;
hagenrap 37:a74d377d8f74 87 extern XNucleoIHM02A12 *x_nucleo_ihm02a1_2;
hagenrap 35:758191d5c6e1 88
hagenrap 35:758191d5c6e1 89 extern DigitalIn mybutton;
hagenrap 35:758191d5c6e1 90
hagenrap 35:758191d5c6e1 91 extern PwmOut Cutter_1;
hagenrap 35:758191d5c6e1 92 extern PwmOut Cutter_2;
hagenrap 35:758191d5c6e1 93 extern PwmOut Spleisser_1;
hagenrap 35:758191d5c6e1 94 extern PwmOut Spleisser_2;
hagenrap 35:758191d5c6e1 95
hagenrap 36:ba2e7eddbafa 96 int material = 0;
hagenrap 36:ba2e7eddbafa 97 float zeit = 0;
hagenrap 36:ba2e7eddbafa 98 int val_LS1 = 0;
hagenrap 36:ba2e7eddbafa 99 int val_LS2 = 0;
hagenrap 36:ba2e7eddbafa 100 int val_LS3 = 0;
hagenrap 36:ba2e7eddbafa 101
scherfa2 38:3776ee18e56f 102
hagenrap 37:a74d377d8f74 103
hagenrap 37:a74d377d8f74 104
hagenrap 36:ba2e7eddbafa 105 Timer machNichts;
hagenrap 36:ba2e7eddbafa 106
hagenrap 39:6cc9a40bc8a6 107 void entry_SOLO_DEFAULT()
hagenrap 39:6cc9a40bc8a6 108 {
hagenrap 39:6cc9a40bc8a6 109 val_LS3 = LS_3.read();
hagenrap 39:6cc9a40bc8a6 110 if(val_LS3 == 0) {
hagenrap 39:6cc9a40bc8a6 111 DisplaySendeBefehl(0x01);
hagenrap 39:6cc9a40bc8a6 112 DisplaySendeBefehl(0x0C);
hagenrap 39:6cc9a40bc8a6 113 gotoxy(1, 1);
hagenrap 39:6cc9a40bc8a6 114 DisplaySendeString("ABBRUCH: ");
hagenrap 39:6cc9a40bc8a6 115 gotoxy(1, 2);
hagenrap 39:6cc9a40bc8a6 116 DisplaySendeString("Filament links");
hagenrap 39:6cc9a40bc8a6 117 gotoxy(1, 4);
hagenrap 39:6cc9a40bc8a6 118 DisplaySendeString("entfernen");
hagenrap 39:6cc9a40bc8a6 119
hagenrap 39:6cc9a40bc8a6 120 Stepper_2_SetPara(TRAVELSPEED, TRAVELACC);
hagenrap 39:6cc9a40bc8a6 121 Stepper_2_Move('V', 5*400);
hagenrap 39:6cc9a40bc8a6 122 }
hagenrap 39:6cc9a40bc8a6 123
hagenrap 39:6cc9a40bc8a6 124 DisplaySendeBefehl(0x01);
hagenrap 39:6cc9a40bc8a6 125 val_LS1 = LS_1.read();
hagenrap 39:6cc9a40bc8a6 126 while(val_LS1 == 0) {
hagenrap 39:6cc9a40bc8a6 127 DisplaySendeBefehl(0x0C);
hagenrap 39:6cc9a40bc8a6 128 gotoxy(1, 1);
hagenrap 39:6cc9a40bc8a6 129 DisplaySendeString("ABBRUCH: ");
hagenrap 39:6cc9a40bc8a6 130 gotoxy(1, 2);
hagenrap 39:6cc9a40bc8a6 131 DisplaySendeString("Filament rechts");
hagenrap 39:6cc9a40bc8a6 132 gotoxy(1, 4);
hagenrap 39:6cc9a40bc8a6 133 DisplaySendeString("entfernen");
hagenrap 39:6cc9a40bc8a6 134 Stepper_1_SetPara(TRAVELSPEED, TRAVELACC);
hagenrap 39:6cc9a40bc8a6 135 Stepper_1_Run('R', TRAVELSPEED);
hagenrap 39:6cc9a40bc8a6 136 val_LS1 = LS_1.read();
hagenrap 39:6cc9a40bc8a6 137 }
hagenrap 39:6cc9a40bc8a6 138
hagenrap 39:6cc9a40bc8a6 139 StatusSOLO = SOLO_DEFAULT;
hagenrap 39:6cc9a40bc8a6 140 }
hagenrap 39:6cc9a40bc8a6 141
hagenrap 39:6cc9a40bc8a6 142
hagenrap 39:6cc9a40bc8a6 143
hagenrap 39:6cc9a40bc8a6 144
hagenrap 39:6cc9a40bc8a6 145 void entry_SOLO_DEFAULT_END()
hagenrap 39:6cc9a40bc8a6 146 {
hagenrap 39:6cc9a40bc8a6 147 DisplaySendeBefehl(0x01);
hagenrap 39:6cc9a40bc8a6 148 DisplaySendeBefehl(0x0C);
hagenrap 39:6cc9a40bc8a6 149 gotoxy(1, 1);
hagenrap 39:6cc9a40bc8a6 150 DisplaySendeString("Filament links");
hagenrap 39:6cc9a40bc8a6 151 gotoxy(1, 3);
hagenrap 39:6cc9a40bc8a6 152 DisplaySendeString("entfernen");
hagenrap 39:6cc9a40bc8a6 153 gotoxy(1, 4);
hagenrap 39:6cc9a40bc8a6 154 DisplaySendeString("Bestaetigen");
hagenrap 39:6cc9a40bc8a6 155
hagenrap 39:6cc9a40bc8a6 156 while(SOLO_Button1 == false) {
hagenrap 39:6cc9a40bc8a6 157 SOLO_Button1 = get_Button_1();
hagenrap 39:6cc9a40bc8a6 158 }
hagenrap 39:6cc9a40bc8a6 159 SOLO_Button1 = false;
hagenrap 39:6cc9a40bc8a6 160
hagenrap 39:6cc9a40bc8a6 161 StatusSOLO = SOLO_DEFAULT;
hagenrap 39:6cc9a40bc8a6 162 }
hagenrap 39:6cc9a40bc8a6 163
hagenrap 39:6cc9a40bc8a6 164
hagenrap 39:6cc9a40bc8a6 165
hagenrap 39:6cc9a40bc8a6 166 void entry_SOLO_START()
hagenrap 39:6cc9a40bc8a6 167 {
hagenrap 39:6cc9a40bc8a6 168 Stepper_1_Leerlauf();
hagenrap 39:6cc9a40bc8a6 169 Stepper_2_Leerlauf();
hagenrap 39:6cc9a40bc8a6 170
scherfa2 40:117b324843ee 171 printf("Funktion_SOLOSTART\r");
scherfa2 40:117b324843ee 172
hagenrap 39:6cc9a40bc8a6 173 DisplaySendeBefehl(0x01);
hagenrap 39:6cc9a40bc8a6 174 DisplaySendeBefehl(0x0C);
hagenrap 39:6cc9a40bc8a6 175 gotoxy(1, 1);
hagenrap 39:6cc9a40bc8a6 176 DisplaySendeString("MODUS: SOLO-Betrieb");
hagenrap 39:6cc9a40bc8a6 177
hagenrap 39:6cc9a40bc8a6 178 Set_Servo_Good_Fil();
hagenrap 39:6cc9a40bc8a6 179 //Servo_Off();
hagenrap 39:6cc9a40bc8a6 180
hagenrap 39:6cc9a40bc8a6 181 Thread::wait(1000); // Damit Button nicht zwei mal gedrückt
hagenrap 39:6cc9a40bc8a6 182
hagenrap 39:6cc9a40bc8a6 183 StatusSOLO = SOLO_START;
hagenrap 39:6cc9a40bc8a6 184 }
hagenrap 39:6cc9a40bc8a6 185
hagenrap 39:6cc9a40bc8a6 186
hagenrap 39:6cc9a40bc8a6 187
hagenrap 39:6cc9a40bc8a6 188
hagenrap 39:6cc9a40bc8a6 189
hagenrap 39:6cc9a40bc8a6 190
hagenrap 39:6cc9a40bc8a6 191 void entry_SOLO_EinlegenIN()
hagenrap 39:6cc9a40bc8a6 192 {
hagenrap 39:6cc9a40bc8a6 193 DisplaySendeBefehl(0x01);
hagenrap 39:6cc9a40bc8a6 194 DisplaySendeBefehl(0x0C);
hagenrap 39:6cc9a40bc8a6 195 gotoxy(1, 1);
hagenrap 39:6cc9a40bc8a6 196 DisplaySendeString("Filament rechts");
hagenrap 39:6cc9a40bc8a6 197 gotoxy(1, 3);
hagenrap 39:6cc9a40bc8a6 198 DisplaySendeString("einlegen");
hagenrap 39:6cc9a40bc8a6 199 gotoxy(1, 4);
hagenrap 39:6cc9a40bc8a6 200 DisplaySendeString(" Abbruch");
hagenrap 39:6cc9a40bc8a6 201
hagenrap 39:6cc9a40bc8a6 202 StatusSOLO = SOLO_EinlegenIN;
hagenrap 39:6cc9a40bc8a6 203 }
hagenrap 39:6cc9a40bc8a6 204
hagenrap 39:6cc9a40bc8a6 205
hagenrap 39:6cc9a40bc8a6 206
hagenrap 39:6cc9a40bc8a6 207
hagenrap 39:6cc9a40bc8a6 208 void entry_SOLO_INtoSPLEISSER()
hagenrap 39:6cc9a40bc8a6 209 {
hagenrap 39:6cc9a40bc8a6 210 DisplaySendeBefehl(0x01);
hagenrap 39:6cc9a40bc8a6 211 DisplaySendeBefehl(0x0C);
hagenrap 39:6cc9a40bc8a6 212 gotoxy(1, 1);
hagenrap 39:6cc9a40bc8a6 213 DisplaySendeString("Filament rechts");
hagenrap 39:6cc9a40bc8a6 214 gotoxy(1, 3);
hagenrap 39:6cc9a40bc8a6 215 DisplaySendeString("bereit");
hagenrap 39:6cc9a40bc8a6 216 gotoxy(1, 4);
hagenrap 39:6cc9a40bc8a6 217 DisplaySendeString("Weiter Abbruch");
hagenrap 39:6cc9a40bc8a6 218
hagenrap 39:6cc9a40bc8a6 219 StatusSOLO = SOLO_INtoSPLEISSER;
hagenrap 39:6cc9a40bc8a6 220 }
hagenrap 39:6cc9a40bc8a6 221
hagenrap 39:6cc9a40bc8a6 222
hagenrap 39:6cc9a40bc8a6 223
hagenrap 39:6cc9a40bc8a6 224
hagenrap 39:6cc9a40bc8a6 225 void entry_SOLO_EinlegenOUT()
hagenrap 39:6cc9a40bc8a6 226 {
hagenrap 39:6cc9a40bc8a6 227 DisplaySendeBefehl(0x01);
hagenrap 39:6cc9a40bc8a6 228 DisplaySendeBefehl(0x0C);
hagenrap 39:6cc9a40bc8a6 229 gotoxy(1, 1);
hagenrap 39:6cc9a40bc8a6 230 DisplaySendeString("Filament links");
hagenrap 39:6cc9a40bc8a6 231 gotoxy(1, 3);
hagenrap 39:6cc9a40bc8a6 232 DisplaySendeString("einlegen");
hagenrap 39:6cc9a40bc8a6 233 gotoxy(1, 4);
hagenrap 39:6cc9a40bc8a6 234 DisplaySendeString(" Abbruch");
hagenrap 39:6cc9a40bc8a6 235
hagenrap 39:6cc9a40bc8a6 236 StatusSOLO = SOLO_EinlegenOUT;
hagenrap 39:6cc9a40bc8a6 237 }
hagenrap 39:6cc9a40bc8a6 238
hagenrap 39:6cc9a40bc8a6 239
hagenrap 39:6cc9a40bc8a6 240
hagenrap 39:6cc9a40bc8a6 241
hagenrap 39:6cc9a40bc8a6 242 void entry_SOLO_OUTtoSPLEISSER()
hagenrap 39:6cc9a40bc8a6 243 {
hagenrap 39:6cc9a40bc8a6 244 DisplaySendeBefehl(0x01);
hagenrap 39:6cc9a40bc8a6 245 DisplaySendeBefehl(0x0C);
hagenrap 39:6cc9a40bc8a6 246 gotoxy(1, 1);
hagenrap 39:6cc9a40bc8a6 247 DisplaySendeString("Filamente bereit");
hagenrap 39:6cc9a40bc8a6 248 gotoxy(1, 4);
hagenrap 39:6cc9a40bc8a6 249 DisplaySendeString("Spleissen Abbruch");
hagenrap 39:6cc9a40bc8a6 250
hagenrap 39:6cc9a40bc8a6 251 StatusSOLO = SOLO_OUTtoSPLEISSER;
hagenrap 39:6cc9a40bc8a6 252 }
hagenrap 39:6cc9a40bc8a6 253
hagenrap 39:6cc9a40bc8a6 254
hagenrap 39:6cc9a40bc8a6 255
hagenrap 39:6cc9a40bc8a6 256
hagenrap 39:6cc9a40bc8a6 257
hagenrap 39:6cc9a40bc8a6 258 void entry_SOLO_Spleissen()
hagenrap 39:6cc9a40bc8a6 259 {
hagenrap 39:6cc9a40bc8a6 260 DisplaySendeBefehl(0x01);
hagenrap 39:6cc9a40bc8a6 261 DisplaySendeBefehl(0x0C);
hagenrap 39:6cc9a40bc8a6 262 gotoxy(1, 1);
hagenrap 39:6cc9a40bc8a6 263 DisplaySendeString("ACHTUNG:");
hagenrap 39:6cc9a40bc8a6 264 gotoxy(1, 2);
hagenrap 39:6cc9a40bc8a6 265 DisplaySendeString("SPLEISSENUNG!!!");
hagenrap 39:6cc9a40bc8a6 266
hagenrap 39:6cc9a40bc8a6 267 StatusSOLO = SOLO_Spleissen;
hagenrap 39:6cc9a40bc8a6 268 }
hagenrap 39:6cc9a40bc8a6 269
hagenrap 39:6cc9a40bc8a6 270
hagenrap 39:6cc9a40bc8a6 271
hagenrap 39:6cc9a40bc8a6 272
hagenrap 39:6cc9a40bc8a6 273
hagenrap 39:6cc9a40bc8a6 274 void entry_SOLO_FERTIG()
hagenrap 39:6cc9a40bc8a6 275 {
hagenrap 39:6cc9a40bc8a6 276 DisplaySendeBefehl(0x01);
hagenrap 39:6cc9a40bc8a6 277 DisplaySendeBefehl(0x0C);
hagenrap 39:6cc9a40bc8a6 278 gotoxy(1, 1);
hagenrap 39:6cc9a40bc8a6 279 DisplaySendeString("Filament wird");
hagenrap 39:6cc9a40bc8a6 280 gotoxy(1, 2);
hagenrap 39:6cc9a40bc8a6 281 DisplaySendeString("abgekuehlt");
hagenrap 39:6cc9a40bc8a6 282
hagenrap 39:6cc9a40bc8a6 283 Thread::wait(COOLINGTIME*1000);
hagenrap 39:6cc9a40bc8a6 284
hagenrap 39:6cc9a40bc8a6 285 StatusSOLO = SOLO_FERTIG;
hagenrap 39:6cc9a40bc8a6 286 }
hagenrap 39:6cc9a40bc8a6 287
hagenrap 39:6cc9a40bc8a6 288
hagenrap 39:6cc9a40bc8a6 289
hagenrap 39:6cc9a40bc8a6 290
hagenrap 39:6cc9a40bc8a6 291
hagenrap 39:6cc9a40bc8a6 292 void Fkt_SOLO_Spleissen()
hagenrap 36:ba2e7eddbafa 293 {
hagenrap 41:1a2ba8849aa6 294 Stepper_1_SetPara(PRECISIONSPEED, PRECISIONACC);
hagenrap 41:1a2ba8849aa6 295 Stepper_1_Move('V', 0.11*400);
hagenrap 41:1a2ba8849aa6 296
hagenrap 41:1a2ba8849aa6 297 Stepper_1_SetPara(PRECISIONSPEED, PRECISIONACC);
hagenrap 39:6cc9a40bc8a6 298 Stepper_2_SetPara(PRECISIONSPEED, PRECISIONACC);
hagenrap 41:1a2ba8849aa6 299
hagenrap 41:1a2ba8849aa6 300 motors[0]->move(StepperMotor::BWD, 128*400*0.25);
hagenrap 41:1a2ba8849aa6 301 motors[1]->move(StepperMotor::BWD, 128*400*0.26);
hagenrap 39:6cc9a40bc8a6 302
hagenrap 39:6cc9a40bc8a6 303 Set_Spleisser(ARConTIME, ARCoffTIME, REPETITONS);
hagenrap 41:1a2ba8849aa6 304
hagenrap 41:1a2ba8849aa6 305 motors[0]->wait_while_active();
hagenrap 41:1a2ba8849aa6 306 motors[1]->wait_while_active();
hagenrap 41:1a2ba8849aa6 307
hagenrap 41:1a2ba8849aa6 308 motors[0]->move(StepperMotor::FWD, 128*400*0.13);
hagenrap 41:1a2ba8849aa6 309 motors[1]->move(StepperMotor::FWD, 128*400*0.14);
hagenrap 41:1a2ba8849aa6 310
hagenrap 41:1a2ba8849aa6 311 Set_Spleisser(ARConTIME, ARCoffTIME, REPETITONS+2);
hagenrap 41:1a2ba8849aa6 312
hagenrap 41:1a2ba8849aa6 313 motors[0]->wait_while_active();
hagenrap 41:1a2ba8849aa6 314 motors[1]->wait_while_active();
hagenrap 41:1a2ba8849aa6 315
hagenrap 41:1a2ba8849aa6 316
hagenrap 39:6cc9a40bc8a6 317 Stepper_1_SetPara(FILSPEED, FILACC);
hagenrap 39:6cc9a40bc8a6 318 Stepper_2_SetPara(FILSPEED, FILACC);
hagenrap 39:6cc9a40bc8a6 319
hagenrap 41:1a2ba8849aa6 320 motors[0]->move(StepperMotor::BWD, 0.55*400*128);
hagenrap 39:6cc9a40bc8a6 321 Thread::wait(10);
hagenrap 41:1a2ba8849aa6 322 Stepper_2_Move('R', 0.65*400);
hagenrap 36:ba2e7eddbafa 323 }
hagenrap 36:ba2e7eddbafa 324
hagenrap 39:6cc9a40bc8a6 325
hagenrap 39:6cc9a40bc8a6 326
hagenrap 39:6cc9a40bc8a6 327
hagenrap 39:6cc9a40bc8a6 328
hagenrap 39:6cc9a40bc8a6 329 void EntrySOLO()
hagenrap 39:6cc9a40bc8a6 330 {
hagenrap 39:6cc9a40bc8a6 331
hagenrap 39:6cc9a40bc8a6 332 SOLO_Button1 = get_Button_1();
hagenrap 39:6cc9a40bc8a6 333 SOLO_Button2 = get_Button_2();
hagenrap 39:6cc9a40bc8a6 334
hagenrap 39:6cc9a40bc8a6 335 switch(StatusSOLO) {
hagenrap 39:6cc9a40bc8a6 336
hagenrap 39:6cc9a40bc8a6 337
hagenrap 39:6cc9a40bc8a6 338 case SOLO_DEFAULT:
scherfa2 40:117b324843ee 339 printf("MODUS SOLO\n\r");
hagenrap 39:6cc9a40bc8a6 340
scherfa2 40:117b324843ee 341 entry_SOLO_START();
hagenrap 39:6cc9a40bc8a6 342
hagenrap 39:6cc9a40bc8a6 343 break;
hagenrap 39:6cc9a40bc8a6 344
hagenrap 39:6cc9a40bc8a6 345
hagenrap 39:6cc9a40bc8a6 346
hagenrap 39:6cc9a40bc8a6 347
hagenrap 39:6cc9a40bc8a6 348
hagenrap 39:6cc9a40bc8a6 349 case SOLO_START:
scherfa2 40:117b324843ee 350 printf("MODUS SOLO\n\r");
hagenrap 39:6cc9a40bc8a6 351 if(material == 1) {
hagenrap 39:6cc9a40bc8a6 352 gotoxy(1, 4);
hagenrap 39:6cc9a40bc8a6 353 DisplaySendeString("Start ABS");
hagenrap 39:6cc9a40bc8a6 354 } else if(material == 0) {
hagenrap 39:6cc9a40bc8a6 355 gotoxy(1, 4);
hagenrap 39:6cc9a40bc8a6 356 DisplaySendeString("Start PLA");
hagenrap 39:6cc9a40bc8a6 357 }
hagenrap 39:6cc9a40bc8a6 358
hagenrap 39:6cc9a40bc8a6 359 if(SOLO_Button1 == true) {
hagenrap 39:6cc9a40bc8a6 360 SOLO_Button1 = false;
hagenrap 39:6cc9a40bc8a6 361 entry_SOLO_EinlegenIN();
hagenrap 39:6cc9a40bc8a6 362 }
hagenrap 39:6cc9a40bc8a6 363
hagenrap 39:6cc9a40bc8a6 364 if(SOLO_Button2 == true) {
hagenrap 39:6cc9a40bc8a6 365 SOLO_Button2 = false;
hagenrap 39:6cc9a40bc8a6 366 material = !material;
hagenrap 39:6cc9a40bc8a6 367 Thread::wait(300);
hagenrap 39:6cc9a40bc8a6 368 }
hagenrap 39:6cc9a40bc8a6 369
hagenrap 39:6cc9a40bc8a6 370 break;
hagenrap 39:6cc9a40bc8a6 371
hagenrap 39:6cc9a40bc8a6 372
hagenrap 39:6cc9a40bc8a6 373
hagenrap 39:6cc9a40bc8a6 374
hagenrap 39:6cc9a40bc8a6 375
hagenrap 39:6cc9a40bc8a6 376 case SOLO_EinlegenIN:
hagenrap 39:6cc9a40bc8a6 377
hagenrap 39:6cc9a40bc8a6 378 val_LS2 = LS_2.read();
hagenrap 39:6cc9a40bc8a6 379 val_LS3 = LS_3.read();
hagenrap 39:6cc9a40bc8a6 380 if(val_LS2 == 1) {
hagenrap 39:6cc9a40bc8a6 381 Stepper_1_SetPara(TRAVELSPEED, TRAVELACC);
hagenrap 39:6cc9a40bc8a6 382 Stepper_1_Run('V', TRAVELSPEED);
hagenrap 39:6cc9a40bc8a6 383 } else if (val_LS2 == 0 && val_LS3 == 1) {
hagenrap 39:6cc9a40bc8a6 384 Stepper_1_Run('V', PRECISIONSPEED);;
hagenrap 39:6cc9a40bc8a6 385 } else if (val_LS2 == 0 && val_LS3 == 0) {
hagenrap 39:6cc9a40bc8a6 386 Stepper_1_Stop();
hagenrap 39:6cc9a40bc8a6 387 Stepper_1_SetPara(PRECISIONSPEED, PRECISIONACC);
hagenrap 41:1a2ba8849aa6 388 Stepper_1_Move('R', 0.11*400);
hagenrap 39:6cc9a40bc8a6 389 entry_SOLO_INtoSPLEISSER();
hagenrap 39:6cc9a40bc8a6 390 }
hagenrap 39:6cc9a40bc8a6 391
hagenrap 39:6cc9a40bc8a6 392 if(SOLO_Button2 == true) {
hagenrap 39:6cc9a40bc8a6 393 SOLO_Button2 = false;
hagenrap 39:6cc9a40bc8a6 394 entry_SOLO_DEFAULT();
hagenrap 39:6cc9a40bc8a6 395 }
hagenrap 39:6cc9a40bc8a6 396
hagenrap 39:6cc9a40bc8a6 397 break;
hagenrap 39:6cc9a40bc8a6 398
hagenrap 39:6cc9a40bc8a6 399
hagenrap 39:6cc9a40bc8a6 400
hagenrap 39:6cc9a40bc8a6 401
hagenrap 39:6cc9a40bc8a6 402
hagenrap 39:6cc9a40bc8a6 403 case SOLO_INtoSPLEISSER:
hagenrap 39:6cc9a40bc8a6 404
hagenrap 39:6cc9a40bc8a6 405 if(SOLO_Button1 == true) {
hagenrap 39:6cc9a40bc8a6 406 SOLO_Button1 = false;
hagenrap 39:6cc9a40bc8a6 407 entry_SOLO_EinlegenOUT();
hagenrap 39:6cc9a40bc8a6 408 }
hagenrap 39:6cc9a40bc8a6 409
hagenrap 39:6cc9a40bc8a6 410 if(SOLO_Button2 == true) {
hagenrap 39:6cc9a40bc8a6 411 SOLO_Button2 = false;
hagenrap 39:6cc9a40bc8a6 412 entry_SOLO_DEFAULT();
hagenrap 39:6cc9a40bc8a6 413 }
hagenrap 39:6cc9a40bc8a6 414
hagenrap 39:6cc9a40bc8a6 415 break;
hagenrap 39:6cc9a40bc8a6 416
hagenrap 39:6cc9a40bc8a6 417
hagenrap 39:6cc9a40bc8a6 418
hagenrap 39:6cc9a40bc8a6 419
hagenrap 39:6cc9a40bc8a6 420
hagenrap 39:6cc9a40bc8a6 421
hagenrap 39:6cc9a40bc8a6 422 case SOLO_EinlegenOUT:
hagenrap 39:6cc9a40bc8a6 423
hagenrap 39:6cc9a40bc8a6 424 val_LS3 = LS_3.read();
hagenrap 39:6cc9a40bc8a6 425 if(val_LS3 == 1) {
hagenrap 39:6cc9a40bc8a6 426 Stepper_2_SetPara(PRECISIONSPEED, PRECISIONACC);
hagenrap 39:6cc9a40bc8a6 427 Stepper_2_Run('R', PRECISIONSPEED);
hagenrap 39:6cc9a40bc8a6 428 } else if (val_LS3 == 0) {
hagenrap 39:6cc9a40bc8a6 429 Stepper_2_Stop();
hagenrap 39:6cc9a40bc8a6 430 entry_SOLO_OUTtoSPLEISSER();
hagenrap 39:6cc9a40bc8a6 431 }
hagenrap 39:6cc9a40bc8a6 432
hagenrap 39:6cc9a40bc8a6 433 if(SOLO_Button2 == true) {
hagenrap 39:6cc9a40bc8a6 434 SOLO_Button2 = false;
hagenrap 39:6cc9a40bc8a6 435 entry_SOLO_DEFAULT();
hagenrap 39:6cc9a40bc8a6 436 }
hagenrap 39:6cc9a40bc8a6 437
hagenrap 39:6cc9a40bc8a6 438 break;
hagenrap 39:6cc9a40bc8a6 439
hagenrap 39:6cc9a40bc8a6 440
hagenrap 39:6cc9a40bc8a6 441
hagenrap 39:6cc9a40bc8a6 442
hagenrap 39:6cc9a40bc8a6 443 case SOLO_OUTtoSPLEISSER:
hagenrap 39:6cc9a40bc8a6 444
hagenrap 39:6cc9a40bc8a6 445 if(SOLO_Button1 == true) {
hagenrap 39:6cc9a40bc8a6 446 SOLO_Button1 = false;
hagenrap 39:6cc9a40bc8a6 447 entry_SOLO_Spleissen();
hagenrap 39:6cc9a40bc8a6 448 }
hagenrap 39:6cc9a40bc8a6 449
hagenrap 39:6cc9a40bc8a6 450 if(SOLO_Button2 == true) {
hagenrap 39:6cc9a40bc8a6 451 SOLO_Button2 = false;
hagenrap 39:6cc9a40bc8a6 452 entry_SOLO_DEFAULT();
hagenrap 39:6cc9a40bc8a6 453 }
hagenrap 39:6cc9a40bc8a6 454
hagenrap 39:6cc9a40bc8a6 455 break;
hagenrap 39:6cc9a40bc8a6 456
hagenrap 39:6cc9a40bc8a6 457 case SOLO_Spleissen:
hagenrap 39:6cc9a40bc8a6 458
hagenrap 39:6cc9a40bc8a6 459 Fkt_SOLO_Spleissen();
hagenrap 39:6cc9a40bc8a6 460
hagenrap 39:6cc9a40bc8a6 461 entry_SOLO_FERTIG();
hagenrap 39:6cc9a40bc8a6 462
hagenrap 39:6cc9a40bc8a6 463 break;
hagenrap 39:6cc9a40bc8a6 464
hagenrap 39:6cc9a40bc8a6 465
hagenrap 39:6cc9a40bc8a6 466
hagenrap 39:6cc9a40bc8a6 467
hagenrap 39:6cc9a40bc8a6 468
hagenrap 39:6cc9a40bc8a6 469 case SOLO_FERTIG:
hagenrap 39:6cc9a40bc8a6 470
hagenrap 39:6cc9a40bc8a6 471 DisplaySendeBefehl(0x01);
hagenrap 39:6cc9a40bc8a6 472 DisplaySendeBefehl(0x0C);
hagenrap 39:6cc9a40bc8a6 473 gotoxy(1, 1);
hagenrap 39:6cc9a40bc8a6 474 DisplaySendeString("Filament wird");
hagenrap 39:6cc9a40bc8a6 475 gotoxy(1, 2);
hagenrap 39:6cc9a40bc8a6 476 DisplaySendeString("ausgeworfen");
hagenrap 39:6cc9a40bc8a6 477
hagenrap 39:6cc9a40bc8a6 478 val_LS3 = LS_3.read();
hagenrap 39:6cc9a40bc8a6 479 while(val_LS3 == 0) {
hagenrap 39:6cc9a40bc8a6 480 Stepper_1_SetPara(TRAVELSPEED, SLOWACC);
hagenrap 39:6cc9a40bc8a6 481 Stepper_2_SetPara(TRAVELSPEED, SLOWACC);
hagenrap 39:6cc9a40bc8a6 482
hagenrap 39:6cc9a40bc8a6 483 motors[0]->run(StepperMotor::FWD, TRAVELSPEED+200);
hagenrap 39:6cc9a40bc8a6 484 motors[1]->run(StepperMotor::FWD, TRAVELSPEED+200);
hagenrap 39:6cc9a40bc8a6 485
hagenrap 39:6cc9a40bc8a6 486 //Stepper_1_Run('V', TRAVELSPEED+100);
hagenrap 39:6cc9a40bc8a6 487 //Stepper_2_Run('V', TRAVELSPEED+100);
hagenrap 39:6cc9a40bc8a6 488
hagenrap 39:6cc9a40bc8a6 489 val_LS3 = LS_3.read();
hagenrap 39:6cc9a40bc8a6 490 }
hagenrap 39:6cc9a40bc8a6 491
hagenrap 39:6cc9a40bc8a6 492 Stepper_1_Leerlauf();
hagenrap 39:6cc9a40bc8a6 493 Stepper_2_Leerlauf();
hagenrap 39:6cc9a40bc8a6 494
hagenrap 39:6cc9a40bc8a6 495 entry_SOLO_DEFAULT_END();
hagenrap 39:6cc9a40bc8a6 496
hagenrap 39:6cc9a40bc8a6 497 break;
hagenrap 39:6cc9a40bc8a6 498
hagenrap 39:6cc9a40bc8a6 499 case SOLO_STOERUNG:
hagenrap 39:6cc9a40bc8a6 500
hagenrap 39:6cc9a40bc8a6 501 break;
hagenrap 39:6cc9a40bc8a6 502
hagenrap 39:6cc9a40bc8a6 503 }
hagenrap 39:6cc9a40bc8a6 504 }
hagenrap 39:6cc9a40bc8a6 505
hagenrap 39:6cc9a40bc8a6 506
hagenrap 39:6cc9a40bc8a6 507 /*
hagenrap 39:6cc9a40bc8a6 508
hagenrap 36:ba2e7eddbafa 509 void entry_SOLO_DEFAULT()
hagenrap 36:ba2e7eddbafa 510 {
hagenrap 36:ba2e7eddbafa 511 StatusSOLO = SOLO_DEFAULT;
hagenrap 37:a74d377d8f74 512 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 513 machNichts.stop();
hagenrap 36:ba2e7eddbafa 514 machNichts.reset();
hagenrap 36:ba2e7eddbafa 515 zeit = 0;
hagenrap 36:ba2e7eddbafa 516 val_LS1 = LS_1.read();
hagenrap 36:ba2e7eddbafa 517 if(val_LS1 == 0) {
hagenrap 36:ba2e7eddbafa 518 while(val_LS1 == 0) {
hagenrap 37:a74d377d8f74 519 Stepper_1_Run('R', 500);
hagenrap 36:ba2e7eddbafa 520 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 521 DisplaySendeString("ABBRUCH:");
hagenrap 36:ba2e7eddbafa 522 gotoxy(1, 2);
hagenrap 36:ba2e7eddbafa 523 DisplaySendeString("Filament rechts");
hagenrap 36:ba2e7eddbafa 524 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 525 DisplaySendeString("entfernen");
hagenrap 36:ba2e7eddbafa 526 val_LS1 = LS_1.read();
hagenrap 36:ba2e7eddbafa 527 }
hagenrap 36:ba2e7eddbafa 528 }
hagenrap 36:ba2e7eddbafa 529 val_LS3 = LS_3.read();
hagenrap 36:ba2e7eddbafa 530 if(val_LS3 == 0) {
hagenrap 36:ba2e7eddbafa 531 while(val_LS3 == 0) {
hagenrap 37:a74d377d8f74 532 Stepper_2_Run('V', 500);
hagenrap 36:ba2e7eddbafa 533 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 534 DisplaySendeString("ABBRUCH:");
hagenrap 36:ba2e7eddbafa 535 gotoxy(1, 2);
hagenrap 36:ba2e7eddbafa 536 DisplaySendeString("Filament links");
hagenrap 36:ba2e7eddbafa 537 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 538 DisplaySendeString("entfernen");
hagenrap 37:a74d377d8f74 539 val_LS3 = LS_3.read();
hagenrap 36:ba2e7eddbafa 540 }
hagenrap 36:ba2e7eddbafa 541 }
hagenrap 36:ba2e7eddbafa 542 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 543 }
hagenrap 36:ba2e7eddbafa 544
hagenrap 36:ba2e7eddbafa 545 void entry_SOLO_EinlegenIN()
hagenrap 36:ba2e7eddbafa 546 {
hagenrap 36:ba2e7eddbafa 547 StatusSOLO = SOLO_EinlegenIN;
hagenrap 36:ba2e7eddbafa 548 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 549 machNichts.start();
hagenrap 36:ba2e7eddbafa 550 Set_Servo_Good_Fil();
hagenrap 36:ba2e7eddbafa 551
hagenrap 36:ba2e7eddbafa 552 }
hagenrap 36:ba2e7eddbafa 553
hagenrap 36:ba2e7eddbafa 554 void entry_SOLO_INtoSPLEISSER()
hagenrap 36:ba2e7eddbafa 555 {
hagenrap 36:ba2e7eddbafa 556 StatusSOLO = SOLO_INtoSPLEISSER;
hagenrap 36:ba2e7eddbafa 557 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 558 machNichts.stop();
hagenrap 36:ba2e7eddbafa 559 machNichts.reset();
hagenrap 36:ba2e7eddbafa 560 zeit = 0;
hagenrap 36:ba2e7eddbafa 561 machNichts.start();
hagenrap 36:ba2e7eddbafa 562 enable_Buttons();
hagenrap 36:ba2e7eddbafa 563 }
hagenrap 36:ba2e7eddbafa 564
hagenrap 36:ba2e7eddbafa 565 void entry_SOLO_EinlegenOUT()
hagenrap 36:ba2e7eddbafa 566 {
hagenrap 36:ba2e7eddbafa 567 StatusSOLO = SOLO_EinlegenOUT;
hagenrap 36:ba2e7eddbafa 568 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 569 machNichts.stop();
hagenrap 36:ba2e7eddbafa 570 machNichts.reset();
hagenrap 36:ba2e7eddbafa 571 zeit = 0;
hagenrap 36:ba2e7eddbafa 572 machNichts.start();
hagenrap 36:ba2e7eddbafa 573 enable_Buttons();
hagenrap 36:ba2e7eddbafa 574 }
hagenrap 36:ba2e7eddbafa 575
hagenrap 36:ba2e7eddbafa 576 void entry_SOLO_OUTtoSPLEISSER()
hagenrap 36:ba2e7eddbafa 577 {
hagenrap 36:ba2e7eddbafa 578 StatusSOLO = SOLO_OUTtoSPLEISSER;
hagenrap 36:ba2e7eddbafa 579 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 580 machNichts.stop();
hagenrap 36:ba2e7eddbafa 581 machNichts.reset();
hagenrap 36:ba2e7eddbafa 582 zeit = 0;
hagenrap 36:ba2e7eddbafa 583 machNichts.start();
hagenrap 36:ba2e7eddbafa 584 enable_Buttons();
hagenrap 36:ba2e7eddbafa 585 }
hagenrap 36:ba2e7eddbafa 586
hagenrap 36:ba2e7eddbafa 587 void entry_SOLO_Spleissen()
hagenrap 36:ba2e7eddbafa 588 {
hagenrap 37:a74d377d8f74 589 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 590 StatusSOLO = SOLO_Spleissen;
hagenrap 36:ba2e7eddbafa 591 }
scherfa2 29:b84d0cc8bac8 592
scherfa2 27:23bd03a6a6f6 593 void EntrySOLO()
scherfa2 27:23bd03a6a6f6 594 {
hagenrap 39:6cc9a40bc8a6 595
scherfa2 38:3776ee18e56f 596 SOLOButtonSTART = get_Button_1();
scherfa2 38:3776ee18e56f 597 SOLOButtonSTART = get_Button_2();
hagenrap 36:ba2e7eddbafa 598 switch(StatusSOLO) {
hagenrap 36:ba2e7eddbafa 599 case SOLO_DEFAULT:
hagenrap 36:ba2e7eddbafa 600
hagenrap 36:ba2e7eddbafa 601 enable_Buttons();
hagenrap 36:ba2e7eddbafa 602
hagenrap 36:ba2e7eddbafa 603 Stepper_1_Leerlauf();
hagenrap 37:a74d377d8f74 604 Stepper_2_Leerlauf();
hagenrap 37:a74d377d8f74 605
hagenrap 36:ba2e7eddbafa 606
hagenrap 36:ba2e7eddbafa 607 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 608 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 609 DisplaySendeString("Modus: SOLO-Betrieb");
hagenrap 36:ba2e7eddbafa 610 if(material == 1) {
hagenrap 36:ba2e7eddbafa 611 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 612 DisplaySendeString("Start ABS");
hagenrap 36:ba2e7eddbafa 613 } else if(material == 0) {
hagenrap 36:ba2e7eddbafa 614 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 615 DisplaySendeString("Start PLA");
hagenrap 36:ba2e7eddbafa 616 }
hagenrap 36:ba2e7eddbafa 617
scherfa2 38:3776ee18e56f 618 if(SOLOButtonSTART == true) {
hagenrap 39:6cc9a40bc8a6 619
scherfa2 38:3776ee18e56f 620 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 621 //buttonAbbruch_pressed = false;
scherfa2 38:3776ee18e56f 622 //buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 623 material = !material;
hagenrap 36:ba2e7eddbafa 624 }
hagenrap 36:ba2e7eddbafa 625
hagenrap 36:ba2e7eddbafa 626
hagenrap 37:a74d377d8f74 627
scherfa2 38:3776ee18e56f 628 if(SOLOButtonSTART == true) {
hagenrap 39:6cc9a40bc8a6 629
scherfa2 38:3776ee18e56f 630 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 631 //buttonSTART_pressed = false;
scherfa2 38:3776ee18e56f 632 //buttonSTART_diable_cb();
hagenrap 37:a74d377d8f74 633 //entry_SOLO_EinlegenOUT();
hagenrap 36:ba2e7eddbafa 634 entry_SOLO_EinlegenIN();
hagenrap 36:ba2e7eddbafa 635 }
hagenrap 37:a74d377d8f74 636
hagenrap 36:ba2e7eddbafa 637 break;
hagenrap 36:ba2e7eddbafa 638
hagenrap 36:ba2e7eddbafa 639
hagenrap 36:ba2e7eddbafa 640
hagenrap 36:ba2e7eddbafa 641
hagenrap 36:ba2e7eddbafa 642 case SOLO_EinlegenIN:
hagenrap 36:ba2e7eddbafa 643
hagenrap 36:ba2e7eddbafa 644 //Servo_Off();
hagenrap 36:ba2e7eddbafa 645
hagenrap 36:ba2e7eddbafa 646 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 647 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 648 DisplaySendeString("Filament rechts");
hagenrap 36:ba2e7eddbafa 649 gotoxy(1, 3);
hagenrap 36:ba2e7eddbafa 650 DisplaySendeString("einlegen");
hagenrap 36:ba2e7eddbafa 651 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 652 DisplaySendeString(" Abbruch");
hagenrap 36:ba2e7eddbafa 653
hagenrap 36:ba2e7eddbafa 654
scherfa2 38:3776ee18e56f 655 if(SOLOButtonSTART == true) {
scherfa2 38:3776ee18e56f 656 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 657 //buttonAbbruch_pressed = false;
scherfa2 38:3776ee18e56f 658 //buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 659 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 660 }
hagenrap 36:ba2e7eddbafa 661
hagenrap 36:ba2e7eddbafa 662 zeit = machNichts.read();
hagenrap 36:ba2e7eddbafa 663 if(zeit >= WARTEZEIT) {
hagenrap 36:ba2e7eddbafa 664
hagenrap 36:ba2e7eddbafa 665 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 666 }
hagenrap 36:ba2e7eddbafa 667
hagenrap 36:ba2e7eddbafa 668
hagenrap 36:ba2e7eddbafa 669 val_LS2 = LS_2.read();
hagenrap 36:ba2e7eddbafa 670 if(val_LS2 == 1) {
hagenrap 37:a74d377d8f74 671 Stepper_1_Run('V', 100);
hagenrap 36:ba2e7eddbafa 672 } else if (val_LS2 == 0) {
hagenrap 36:ba2e7eddbafa 673 Stepper_1_Stop();
hagenrap 36:ba2e7eddbafa 674 entry_SOLO_INtoSPLEISSER();
hagenrap 36:ba2e7eddbafa 675 }
hagenrap 36:ba2e7eddbafa 676
hagenrap 36:ba2e7eddbafa 677 break;
hagenrap 36:ba2e7eddbafa 678
hagenrap 36:ba2e7eddbafa 679
hagenrap 36:ba2e7eddbafa 680
hagenrap 36:ba2e7eddbafa 681
hagenrap 36:ba2e7eddbafa 682 case SOLO_INtoSPLEISSER:
hagenrap 36:ba2e7eddbafa 683 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 684 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 685 DisplaySendeString("Filament rechts");
hagenrap 36:ba2e7eddbafa 686 gotoxy(1, 3);
hagenrap 36:ba2e7eddbafa 687 DisplaySendeString("bereit");
hagenrap 36:ba2e7eddbafa 688 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 689 DisplaySendeString("Weiter Abbruch");
hagenrap 36:ba2e7eddbafa 690
hagenrap 36:ba2e7eddbafa 691 zeit = machNichts.read();
hagenrap 36:ba2e7eddbafa 692 if(zeit >= WARTEZEIT) {
hagenrap 36:ba2e7eddbafa 693
hagenrap 36:ba2e7eddbafa 694 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 695 }
hagenrap 35:758191d5c6e1 696
scherfa2 38:3776ee18e56f 697 if(SOLOButtonSTART == true) {
scherfa2 38:3776ee18e56f 698 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 699 //buttonAbbruch_pressed = false;
scherfa2 38:3776ee18e56f 700 //buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 701 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 702 }
hagenrap 36:ba2e7eddbafa 703
scherfa2 38:3776ee18e56f 704 if(SOLOButtonSTART == true) {
scherfa2 38:3776ee18e56f 705 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 706 //buttonSTART_pressed = false;
scherfa2 38:3776ee18e56f 707 //buttonSTART_diable_cb();
hagenrap 36:ba2e7eddbafa 708 entry_SOLO_EinlegenOUT();
hagenrap 36:ba2e7eddbafa 709 }
hagenrap 36:ba2e7eddbafa 710
hagenrap 36:ba2e7eddbafa 711 break;
hagenrap 36:ba2e7eddbafa 712
hagenrap 36:ba2e7eddbafa 713 case SOLO_EinlegenOUT:
hagenrap 36:ba2e7eddbafa 714 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 715 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 716 DisplaySendeString("Filament links");
hagenrap 36:ba2e7eddbafa 717 gotoxy(1, 3);
hagenrap 36:ba2e7eddbafa 718 DisplaySendeString("einlegen");
hagenrap 36:ba2e7eddbafa 719 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 720 DisplaySendeString(" Abbruch");
hagenrap 36:ba2e7eddbafa 721
scherfa2 38:3776ee18e56f 722 if(SOLOButtonSTART == true) {
scherfa2 38:3776ee18e56f 723 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 724 //buttonAbbruch_pressed = false;
scherfa2 38:3776ee18e56f 725 //buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 726 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 727 }
hagenrap 36:ba2e7eddbafa 728
hagenrap 36:ba2e7eddbafa 729 zeit = machNichts.read();
hagenrap 36:ba2e7eddbafa 730 if(zeit >= WARTEZEIT) {
hagenrap 36:ba2e7eddbafa 731
hagenrap 36:ba2e7eddbafa 732 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 733 }
hagenrap 36:ba2e7eddbafa 734
hagenrap 36:ba2e7eddbafa 735 val_LS3 = LS_3.read();
hagenrap 36:ba2e7eddbafa 736 if(val_LS3 == 1) {
hagenrap 37:a74d377d8f74 737 Stepper_2_Run('R', 100); /// das isch no Scheisse
hagenrap 36:ba2e7eddbafa 738 } else if (val_LS3 == 0) {
hagenrap 37:a74d377d8f74 739 Stepper_2_Stop();
hagenrap 36:ba2e7eddbafa 740 entry_SOLO_OUTtoSPLEISSER();
hagenrap 36:ba2e7eddbafa 741 }
hagenrap 36:ba2e7eddbafa 742 break;
hagenrap 36:ba2e7eddbafa 743
hagenrap 36:ba2e7eddbafa 744 case SOLO_OUTtoSPLEISSER:
hagenrap 36:ba2e7eddbafa 745 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 746 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 747 DisplaySendeString("Filament links");
hagenrap 36:ba2e7eddbafa 748 gotoxy(1, 3);
hagenrap 36:ba2e7eddbafa 749 DisplaySendeString("bereit");
hagenrap 36:ba2e7eddbafa 750 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 751 DisplaySendeString("Spleissen Abbruch");
hagenrap 36:ba2e7eddbafa 752
hagenrap 36:ba2e7eddbafa 753 zeit = machNichts.read();
hagenrap 36:ba2e7eddbafa 754 if(zeit >= WARTEZEIT) {
hagenrap 36:ba2e7eddbafa 755
hagenrap 36:ba2e7eddbafa 756 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 757 }
hagenrap 36:ba2e7eddbafa 758
scherfa2 38:3776ee18e56f 759 if(SOLOButtonSTART == true) {
scherfa2 38:3776ee18e56f 760 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 761 //buttonAbbruch_pressed = false;
scherfa2 38:3776ee18e56f 762 //buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 763 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 764 }
hagenrap 36:ba2e7eddbafa 765
scherfa2 38:3776ee18e56f 766 if(SOLOButtonSTART == true) {
scherfa2 38:3776ee18e56f 767 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 768 // buttonSTART_pressed = false;
scherfa2 38:3776ee18e56f 769 // buttonSTART_diable_cb();
hagenrap 36:ba2e7eddbafa 770 entry_SOLO_Spleissen();
hagenrap 36:ba2e7eddbafa 771 }
hagenrap 36:ba2e7eddbafa 772 break;
hagenrap 36:ba2e7eddbafa 773
hagenrap 36:ba2e7eddbafa 774 case SOLO_Spleissen:
hagenrap 37:a74d377d8f74 775
hagenrap 37:a74d377d8f74 776 //DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 777 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 778 DisplaySendeString("Spleissen");
hagenrap 36:ba2e7eddbafa 779 gotoxy(1, 3);
hagenrap 37:a74d377d8f74 780 DisplaySendeString("Spleissen");
hagenrap 37:a74d377d8f74 781
hagenrap 37:a74d377d8f74 782
hagenrap 37:a74d377d8f74 783 motors[1]->set_max_speed(50);
hagenrap 37:a74d377d8f74 784 //motors[1]->set_acceleration(5);
hagenrap 37:a74d377d8f74 785 Stepper_2_Move('R', 1.3*400);
hagenrap 37:a74d377d8f74 786 StatusSOLO = SOLO_FERTIG;
hagenrap 37:a74d377d8f74 787
hagenrap 36:ba2e7eddbafa 788 break;
hagenrap 36:ba2e7eddbafa 789
hagenrap 36:ba2e7eddbafa 790 case SOLO_FERTIG:
hagenrap 37:a74d377d8f74 791
hagenrap 37:a74d377d8f74 792 motors[1]->set_max_speed(50);
hagenrap 37:a74d377d8f74 793 motors[1]->set_acceleration(10);
hagenrap 37:a74d377d8f74 794 motors[0]->set_max_speed(55);
hagenrap 37:a74d377d8f74 795 motors[0]->set_acceleration(10);
hagenrap 37:a74d377d8f74 796
hagenrap 37:a74d377d8f74 797 //motors[0]->move(StepperMotor::FWD, 0.2*400*128);
hagenrap 37:a74d377d8f74 798 motors[1]->move(StepperMotor::FWD, 0.05*400*128);
hagenrap 39:6cc9a40bc8a6 799
hagenrap 37:a74d377d8f74 800 //Set_Cutter(400, 200, 4);
hagenrap 37:a74d377d8f74 801
hagenrap 37:a74d377d8f74 802 motors[1]->wait_while_active();
hagenrap 37:a74d377d8f74 803
hagenrap 39:6cc9a40bc8a6 804
hagenrap 37:a74d377d8f74 805
hagenrap 37:a74d377d8f74 806 motors[1]->set_max_speed(300);
hagenrap 37:a74d377d8f74 807 motors[1]->set_acceleration(300);
hagenrap 37:a74d377d8f74 808 motors[0]->set_max_speed(400);
hagenrap 37:a74d377d8f74 809 motors[0]->set_acceleration(400);
hagenrap 37:a74d377d8f74 810
hagenrap 37:a74d377d8f74 811 motors[0]->move(StepperMotor::FWD, 1.2*400*128);
hagenrap 37:a74d377d8f74 812 motors[1]->move(StepperMotor::FWD, 1*400*128);
hagenrap 37:a74d377d8f74 813 motors[1]->wait_while_active();
hagenrap 37:a74d377d8f74 814 Stepper_2_Leerlauf();
hagenrap 39:6cc9a40bc8a6 815
hagenrap 37:a74d377d8f74 816 motors[0]->perform_prepared_actions();
hagenrap 37:a74d377d8f74 817 motors2[0]->perform_prepared_actions();
hagenrap 39:6cc9a40bc8a6 818
hagenrap 37:a74d377d8f74 819
hagenrap 37:a74d377d8f74 820
hagenrap 37:a74d377d8f74 821
hagenrap 37:a74d377d8f74 822
hagenrap 37:a74d377d8f74 823 //motors2[0]->perform_prepared_actions();
hagenrap 37:a74d377d8f74 824
hagenrap 37:a74d377d8f74 825 //Stepper_3_Move('V', 1.3*400);
hagenrap 37:a74d377d8f74 826
hagenrap 37:a74d377d8f74 827
hagenrap 37:a74d377d8f74 828 StatusSOLO = SOLO_STOERUNG;
hagenrap 36:ba2e7eddbafa 829 break;
hagenrap 36:ba2e7eddbafa 830
hagenrap 36:ba2e7eddbafa 831 case SOLO_STOERUNG:
hagenrap 37:a74d377d8f74 832 gotoxy(1, 1);
hagenrap 37:a74d377d8f74 833 DisplaySendeString("fertigfertig");
hagenrap 37:a74d377d8f74 834 gotoxy(1, 3);
hagenrap 37:a74d377d8f74 835 DisplaySendeString("fertigfertig");
hagenrap 36:ba2e7eddbafa 836 break;
hagenrap 36:ba2e7eddbafa 837
hagenrap 36:ba2e7eddbafa 838 }
scherfa2 27:23bd03a6a6f6 839 }
hagenrap 39:6cc9a40bc8a6 840 */