PES_4_Spleisser / Mbed 2 deprecated SpleisserProgramm_V9

Update

Dependencies:   mbed mbed-rtos X_NUCLEO_IHM02A1

ST_SOLO.cpp@40:117b324843ee, 2019-05-14 (annotated)

Committer:
scherfa2
Date:
Tue May 14 20:30:07 2019 +0000
Revision:
40:117b324843ee
Parent:
39:6cc9a40bc8a6
Child:
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 39:6cc9a40bc8a6 294 Stepper_2_SetPara(PRECISIONSPEED, PRECISIONACC);
hagenrap 39:6cc9a40bc8a6 295 Stepper_2_Move('R', 0.11*400);
hagenrap 39:6cc9a40bc8a6 296
hagenrap 39:6cc9a40bc8a6 297 Stepper_1_Move('R', 0.08*400);
hagenrap 39:6cc9a40bc8a6 298 Stepper_2_Move('R', 0.08*400);
hagenrap 39:6cc9a40bc8a6 299
hagenrap 39:6cc9a40bc8a6 300 Set_Spleisser(ARConTIME, ARCoffTIME, REPETITONS);
hagenrap 39:6cc9a40bc8a6 301
hagenrap 39:6cc9a40bc8a6 302
hagenrap 39:6cc9a40bc8a6 303 Stepper_1_SetPara(FILSPEED, FILACC);
hagenrap 39:6cc9a40bc8a6 304 Stepper_2_SetPara(FILSPEED, FILACC);
hagenrap 39:6cc9a40bc8a6 305
hagenrap 39:6cc9a40bc8a6 306 motors[0]->move(StepperMotor::BWD, 0.53*400*128); // kein Move wegen whait!!!!
hagenrap 39:6cc9a40bc8a6 307 Thread::wait(10);
hagenrap 39:6cc9a40bc8a6 308 Stepper_2_Move('R', 0.70*400);
hagenrap 36:ba2e7eddbafa 309 }
hagenrap 36:ba2e7eddbafa 310
hagenrap 39:6cc9a40bc8a6 311
hagenrap 39:6cc9a40bc8a6 312
hagenrap 39:6cc9a40bc8a6 313
hagenrap 39:6cc9a40bc8a6 314
hagenrap 39:6cc9a40bc8a6 315
hagenrap 39:6cc9a40bc8a6 316
hagenrap 39:6cc9a40bc8a6 317
hagenrap 39:6cc9a40bc8a6 318
hagenrap 39:6cc9a40bc8a6 319
hagenrap 39:6cc9a40bc8a6 320 void EntrySOLO()
hagenrap 39:6cc9a40bc8a6 321 {
hagenrap 39:6cc9a40bc8a6 322
hagenrap 39:6cc9a40bc8a6 323 SOLO_Button1 = get_Button_1();
hagenrap 39:6cc9a40bc8a6 324 SOLO_Button2 = get_Button_2();
hagenrap 39:6cc9a40bc8a6 325
hagenrap 39:6cc9a40bc8a6 326 switch(StatusSOLO) {
hagenrap 39:6cc9a40bc8a6 327
hagenrap 39:6cc9a40bc8a6 328
hagenrap 39:6cc9a40bc8a6 329 case SOLO_DEFAULT:
scherfa2 40:117b324843ee 330 printf("MODUS SOLO\n\r");
hagenrap 39:6cc9a40bc8a6 331
scherfa2 40:117b324843ee 332 entry_SOLO_START();
hagenrap 39:6cc9a40bc8a6 333
hagenrap 39:6cc9a40bc8a6 334 break;
hagenrap 39:6cc9a40bc8a6 335
hagenrap 39:6cc9a40bc8a6 336
hagenrap 39:6cc9a40bc8a6 337
hagenrap 39:6cc9a40bc8a6 338
hagenrap 39:6cc9a40bc8a6 339
hagenrap 39:6cc9a40bc8a6 340 case SOLO_START:
scherfa2 40:117b324843ee 341 printf("MODUS SOLO\n\r");
hagenrap 39:6cc9a40bc8a6 342 if(material == 1) {
hagenrap 39:6cc9a40bc8a6 343 gotoxy(1, 4);
hagenrap 39:6cc9a40bc8a6 344 DisplaySendeString("Start ABS");
hagenrap 39:6cc9a40bc8a6 345 } else if(material == 0) {
hagenrap 39:6cc9a40bc8a6 346 gotoxy(1, 4);
hagenrap 39:6cc9a40bc8a6 347 DisplaySendeString("Start PLA");
hagenrap 39:6cc9a40bc8a6 348 }
hagenrap 39:6cc9a40bc8a6 349
hagenrap 39:6cc9a40bc8a6 350 if(SOLO_Button1 == true) {
hagenrap 39:6cc9a40bc8a6 351 SOLO_Button1 = false;
hagenrap 39:6cc9a40bc8a6 352 entry_SOLO_EinlegenIN();
hagenrap 39:6cc9a40bc8a6 353 }
hagenrap 39:6cc9a40bc8a6 354
hagenrap 39:6cc9a40bc8a6 355 if(SOLO_Button2 == true) {
hagenrap 39:6cc9a40bc8a6 356 SOLO_Button2 = false;
hagenrap 39:6cc9a40bc8a6 357 material = !material;
hagenrap 39:6cc9a40bc8a6 358 Thread::wait(300);
hagenrap 39:6cc9a40bc8a6 359 }
hagenrap 39:6cc9a40bc8a6 360
hagenrap 39:6cc9a40bc8a6 361 break;
hagenrap 39:6cc9a40bc8a6 362
hagenrap 39:6cc9a40bc8a6 363
hagenrap 39:6cc9a40bc8a6 364
hagenrap 39:6cc9a40bc8a6 365
hagenrap 39:6cc9a40bc8a6 366
hagenrap 39:6cc9a40bc8a6 367 case SOLO_EinlegenIN:
hagenrap 39:6cc9a40bc8a6 368
hagenrap 39:6cc9a40bc8a6 369 val_LS2 = LS_2.read();
hagenrap 39:6cc9a40bc8a6 370 val_LS3 = LS_3.read();
hagenrap 39:6cc9a40bc8a6 371 if(val_LS2 == 1) {
hagenrap 39:6cc9a40bc8a6 372 Stepper_1_SetPara(TRAVELSPEED, TRAVELACC);
hagenrap 39:6cc9a40bc8a6 373 Stepper_1_Run('V', TRAVELSPEED);
hagenrap 39:6cc9a40bc8a6 374 } else if (val_LS2 == 0 && val_LS3 == 1) {
hagenrap 39:6cc9a40bc8a6 375 Stepper_1_Run('V', PRECISIONSPEED);;
hagenrap 39:6cc9a40bc8a6 376 } else if (val_LS2 == 0 && val_LS3 == 0) {
hagenrap 39:6cc9a40bc8a6 377 Stepper_1_Stop();
hagenrap 39:6cc9a40bc8a6 378 Stepper_1_SetPara(PRECISIONSPEED, PRECISIONACC);
hagenrap 39:6cc9a40bc8a6 379 Stepper_1_Move('R', 0.1*400);
hagenrap 39:6cc9a40bc8a6 380 entry_SOLO_INtoSPLEISSER();
hagenrap 39:6cc9a40bc8a6 381 }
hagenrap 39:6cc9a40bc8a6 382
hagenrap 39:6cc9a40bc8a6 383 if(SOLO_Button2 == true) {
hagenrap 39:6cc9a40bc8a6 384 SOLO_Button2 = false;
hagenrap 39:6cc9a40bc8a6 385 entry_SOLO_DEFAULT();
hagenrap 39:6cc9a40bc8a6 386 }
hagenrap 39:6cc9a40bc8a6 387
hagenrap 39:6cc9a40bc8a6 388 break;
hagenrap 39:6cc9a40bc8a6 389
hagenrap 39:6cc9a40bc8a6 390
hagenrap 39:6cc9a40bc8a6 391
hagenrap 39:6cc9a40bc8a6 392
hagenrap 39:6cc9a40bc8a6 393
hagenrap 39:6cc9a40bc8a6 394 case SOLO_INtoSPLEISSER:
hagenrap 39:6cc9a40bc8a6 395
hagenrap 39:6cc9a40bc8a6 396 if(SOLO_Button1 == true) {
hagenrap 39:6cc9a40bc8a6 397 SOLO_Button1 = false;
hagenrap 39:6cc9a40bc8a6 398 entry_SOLO_EinlegenOUT();
hagenrap 39:6cc9a40bc8a6 399 }
hagenrap 39:6cc9a40bc8a6 400
hagenrap 39:6cc9a40bc8a6 401 if(SOLO_Button2 == true) {
hagenrap 39:6cc9a40bc8a6 402 SOLO_Button2 = false;
hagenrap 39:6cc9a40bc8a6 403 entry_SOLO_DEFAULT();
hagenrap 39:6cc9a40bc8a6 404 }
hagenrap 39:6cc9a40bc8a6 405
hagenrap 39:6cc9a40bc8a6 406 break;
hagenrap 39:6cc9a40bc8a6 407
hagenrap 39:6cc9a40bc8a6 408
hagenrap 39:6cc9a40bc8a6 409
hagenrap 39:6cc9a40bc8a6 410
hagenrap 39:6cc9a40bc8a6 411
hagenrap 39:6cc9a40bc8a6 412
hagenrap 39:6cc9a40bc8a6 413 case SOLO_EinlegenOUT:
hagenrap 39:6cc9a40bc8a6 414
hagenrap 39:6cc9a40bc8a6 415 val_LS3 = LS_3.read();
hagenrap 39:6cc9a40bc8a6 416 if(val_LS3 == 1) {
hagenrap 39:6cc9a40bc8a6 417 Stepper_2_SetPara(PRECISIONSPEED, PRECISIONACC);
hagenrap 39:6cc9a40bc8a6 418 Stepper_2_Run('R', PRECISIONSPEED);
hagenrap 39:6cc9a40bc8a6 419 } else if (val_LS3 == 0) {
hagenrap 39:6cc9a40bc8a6 420 Stepper_2_Stop();
hagenrap 39:6cc9a40bc8a6 421 entry_SOLO_OUTtoSPLEISSER();
hagenrap 39:6cc9a40bc8a6 422 }
hagenrap 39:6cc9a40bc8a6 423
hagenrap 39:6cc9a40bc8a6 424 if(SOLO_Button2 == true) {
hagenrap 39:6cc9a40bc8a6 425 SOLO_Button2 = false;
hagenrap 39:6cc9a40bc8a6 426 entry_SOLO_DEFAULT();
hagenrap 39:6cc9a40bc8a6 427 }
hagenrap 39:6cc9a40bc8a6 428
hagenrap 39:6cc9a40bc8a6 429 break;
hagenrap 39:6cc9a40bc8a6 430
hagenrap 39:6cc9a40bc8a6 431
hagenrap 39:6cc9a40bc8a6 432
hagenrap 39:6cc9a40bc8a6 433
hagenrap 39:6cc9a40bc8a6 434 case SOLO_OUTtoSPLEISSER:
hagenrap 39:6cc9a40bc8a6 435
hagenrap 39:6cc9a40bc8a6 436 if(SOLO_Button1 == true) {
hagenrap 39:6cc9a40bc8a6 437 SOLO_Button1 = false;
hagenrap 39:6cc9a40bc8a6 438 entry_SOLO_Spleissen();
hagenrap 39:6cc9a40bc8a6 439 }
hagenrap 39:6cc9a40bc8a6 440
hagenrap 39:6cc9a40bc8a6 441 if(SOLO_Button2 == true) {
hagenrap 39:6cc9a40bc8a6 442 SOLO_Button2 = false;
hagenrap 39:6cc9a40bc8a6 443 entry_SOLO_DEFAULT();
hagenrap 39:6cc9a40bc8a6 444 }
hagenrap 39:6cc9a40bc8a6 445
hagenrap 39:6cc9a40bc8a6 446 break;
hagenrap 39:6cc9a40bc8a6 447
hagenrap 39:6cc9a40bc8a6 448 case SOLO_Spleissen:
hagenrap 39:6cc9a40bc8a6 449
hagenrap 39:6cc9a40bc8a6 450 Fkt_SOLO_Spleissen();
hagenrap 39:6cc9a40bc8a6 451
hagenrap 39:6cc9a40bc8a6 452 entry_SOLO_FERTIG();
hagenrap 39:6cc9a40bc8a6 453
hagenrap 39:6cc9a40bc8a6 454 break;
hagenrap 39:6cc9a40bc8a6 455
hagenrap 39:6cc9a40bc8a6 456
hagenrap 39:6cc9a40bc8a6 457
hagenrap 39:6cc9a40bc8a6 458
hagenrap 39:6cc9a40bc8a6 459
hagenrap 39:6cc9a40bc8a6 460 case SOLO_FERTIG:
hagenrap 39:6cc9a40bc8a6 461
hagenrap 39:6cc9a40bc8a6 462 DisplaySendeBefehl(0x01);
hagenrap 39:6cc9a40bc8a6 463 DisplaySendeBefehl(0x0C);
hagenrap 39:6cc9a40bc8a6 464 gotoxy(1, 1);
hagenrap 39:6cc9a40bc8a6 465 DisplaySendeString("Filament wird");
hagenrap 39:6cc9a40bc8a6 466 gotoxy(1, 2);
hagenrap 39:6cc9a40bc8a6 467 DisplaySendeString("ausgeworfen");
hagenrap 39:6cc9a40bc8a6 468
hagenrap 39:6cc9a40bc8a6 469 val_LS3 = LS_3.read();
hagenrap 39:6cc9a40bc8a6 470 while(val_LS3 == 0) {
hagenrap 39:6cc9a40bc8a6 471 Stepper_1_SetPara(TRAVELSPEED, SLOWACC);
hagenrap 39:6cc9a40bc8a6 472 Stepper_2_SetPara(TRAVELSPEED, SLOWACC);
hagenrap 39:6cc9a40bc8a6 473
hagenrap 39:6cc9a40bc8a6 474 motors[0]->run(StepperMotor::FWD, TRAVELSPEED+200);
hagenrap 39:6cc9a40bc8a6 475 motors[1]->run(StepperMotor::FWD, TRAVELSPEED+200);
hagenrap 39:6cc9a40bc8a6 476
hagenrap 39:6cc9a40bc8a6 477 //Stepper_1_Run('V', TRAVELSPEED+100);
hagenrap 39:6cc9a40bc8a6 478 //Stepper_2_Run('V', TRAVELSPEED+100);
hagenrap 39:6cc9a40bc8a6 479
hagenrap 39:6cc9a40bc8a6 480 val_LS3 = LS_3.read();
hagenrap 39:6cc9a40bc8a6 481 }
hagenrap 39:6cc9a40bc8a6 482
hagenrap 39:6cc9a40bc8a6 483 Stepper_1_Leerlauf();
hagenrap 39:6cc9a40bc8a6 484 Stepper_2_Leerlauf();
hagenrap 39:6cc9a40bc8a6 485
hagenrap 39:6cc9a40bc8a6 486 entry_SOLO_DEFAULT_END();
hagenrap 39:6cc9a40bc8a6 487
hagenrap 39:6cc9a40bc8a6 488 break;
hagenrap 39:6cc9a40bc8a6 489
hagenrap 39:6cc9a40bc8a6 490 case SOLO_STOERUNG:
hagenrap 39:6cc9a40bc8a6 491
hagenrap 39:6cc9a40bc8a6 492 break;
hagenrap 39:6cc9a40bc8a6 493
hagenrap 39:6cc9a40bc8a6 494 }
hagenrap 39:6cc9a40bc8a6 495 }
hagenrap 39:6cc9a40bc8a6 496
hagenrap 39:6cc9a40bc8a6 497
hagenrap 39:6cc9a40bc8a6 498 /*
hagenrap 39:6cc9a40bc8a6 499
hagenrap 36:ba2e7eddbafa 500 void entry_SOLO_DEFAULT()
hagenrap 36:ba2e7eddbafa 501 {
hagenrap 36:ba2e7eddbafa 502 StatusSOLO = SOLO_DEFAULT;
hagenrap 37:a74d377d8f74 503 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 504 machNichts.stop();
hagenrap 36:ba2e7eddbafa 505 machNichts.reset();
hagenrap 36:ba2e7eddbafa 506 zeit = 0;
hagenrap 36:ba2e7eddbafa 507 val_LS1 = LS_1.read();
hagenrap 36:ba2e7eddbafa 508 if(val_LS1 == 0) {
hagenrap 36:ba2e7eddbafa 509 while(val_LS1 == 0) {
hagenrap 37:a74d377d8f74 510 Stepper_1_Run('R', 500);
hagenrap 36:ba2e7eddbafa 511 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 512 DisplaySendeString("ABBRUCH:");
hagenrap 36:ba2e7eddbafa 513 gotoxy(1, 2);
hagenrap 36:ba2e7eddbafa 514 DisplaySendeString("Filament rechts");
hagenrap 36:ba2e7eddbafa 515 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 516 DisplaySendeString("entfernen");
hagenrap 36:ba2e7eddbafa 517 val_LS1 = LS_1.read();
hagenrap 36:ba2e7eddbafa 518 }
hagenrap 36:ba2e7eddbafa 519 }
hagenrap 36:ba2e7eddbafa 520 val_LS3 = LS_3.read();
hagenrap 36:ba2e7eddbafa 521 if(val_LS3 == 0) {
hagenrap 36:ba2e7eddbafa 522 while(val_LS3 == 0) {
hagenrap 37:a74d377d8f74 523 Stepper_2_Run('V', 500);
hagenrap 36:ba2e7eddbafa 524 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 525 DisplaySendeString("ABBRUCH:");
hagenrap 36:ba2e7eddbafa 526 gotoxy(1, 2);
hagenrap 36:ba2e7eddbafa 527 DisplaySendeString("Filament links");
hagenrap 36:ba2e7eddbafa 528 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 529 DisplaySendeString("entfernen");
hagenrap 37:a74d377d8f74 530 val_LS3 = LS_3.read();
hagenrap 36:ba2e7eddbafa 531 }
hagenrap 36:ba2e7eddbafa 532 }
hagenrap 36:ba2e7eddbafa 533 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 534 }
hagenrap 36:ba2e7eddbafa 535
hagenrap 36:ba2e7eddbafa 536 void entry_SOLO_EinlegenIN()
hagenrap 36:ba2e7eddbafa 537 {
hagenrap 36:ba2e7eddbafa 538 StatusSOLO = SOLO_EinlegenIN;
hagenrap 36:ba2e7eddbafa 539 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 540 machNichts.start();
hagenrap 36:ba2e7eddbafa 541 Set_Servo_Good_Fil();
hagenrap 36:ba2e7eddbafa 542
hagenrap 36:ba2e7eddbafa 543 }
hagenrap 36:ba2e7eddbafa 544
hagenrap 36:ba2e7eddbafa 545 void entry_SOLO_INtoSPLEISSER()
hagenrap 36:ba2e7eddbafa 546 {
hagenrap 36:ba2e7eddbafa 547 StatusSOLO = SOLO_INtoSPLEISSER;
hagenrap 36:ba2e7eddbafa 548 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 549 machNichts.stop();
hagenrap 36:ba2e7eddbafa 550 machNichts.reset();
hagenrap 36:ba2e7eddbafa 551 zeit = 0;
hagenrap 36:ba2e7eddbafa 552 machNichts.start();
hagenrap 36:ba2e7eddbafa 553 enable_Buttons();
hagenrap 36:ba2e7eddbafa 554 }
hagenrap 36:ba2e7eddbafa 555
hagenrap 36:ba2e7eddbafa 556 void entry_SOLO_EinlegenOUT()
hagenrap 36:ba2e7eddbafa 557 {
hagenrap 36:ba2e7eddbafa 558 StatusSOLO = SOLO_EinlegenOUT;
hagenrap 36:ba2e7eddbafa 559 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 560 machNichts.stop();
hagenrap 36:ba2e7eddbafa 561 machNichts.reset();
hagenrap 36:ba2e7eddbafa 562 zeit = 0;
hagenrap 36:ba2e7eddbafa 563 machNichts.start();
hagenrap 36:ba2e7eddbafa 564 enable_Buttons();
hagenrap 36:ba2e7eddbafa 565 }
hagenrap 36:ba2e7eddbafa 566
hagenrap 36:ba2e7eddbafa 567 void entry_SOLO_OUTtoSPLEISSER()
hagenrap 36:ba2e7eddbafa 568 {
hagenrap 36:ba2e7eddbafa 569 StatusSOLO = SOLO_OUTtoSPLEISSER;
hagenrap 36:ba2e7eddbafa 570 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 571 machNichts.stop();
hagenrap 36:ba2e7eddbafa 572 machNichts.reset();
hagenrap 36:ba2e7eddbafa 573 zeit = 0;
hagenrap 36:ba2e7eddbafa 574 machNichts.start();
hagenrap 36:ba2e7eddbafa 575 enable_Buttons();
hagenrap 36:ba2e7eddbafa 576 }
hagenrap 36:ba2e7eddbafa 577
hagenrap 36:ba2e7eddbafa 578 void entry_SOLO_Spleissen()
hagenrap 36:ba2e7eddbafa 579 {
hagenrap 37:a74d377d8f74 580 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 581 StatusSOLO = SOLO_Spleissen;
hagenrap 36:ba2e7eddbafa 582 }
scherfa2 29:b84d0cc8bac8 583
scherfa2 27:23bd03a6a6f6 584 void EntrySOLO()
scherfa2 27:23bd03a6a6f6 585 {
hagenrap 39:6cc9a40bc8a6 586
scherfa2 38:3776ee18e56f 587 SOLOButtonSTART = get_Button_1();
scherfa2 38:3776ee18e56f 588 SOLOButtonSTART = get_Button_2();
hagenrap 36:ba2e7eddbafa 589 switch(StatusSOLO) {
hagenrap 36:ba2e7eddbafa 590 case SOLO_DEFAULT:
hagenrap 36:ba2e7eddbafa 591
hagenrap 36:ba2e7eddbafa 592 enable_Buttons();
hagenrap 36:ba2e7eddbafa 593
hagenrap 36:ba2e7eddbafa 594 Stepper_1_Leerlauf();
hagenrap 37:a74d377d8f74 595 Stepper_2_Leerlauf();
hagenrap 37:a74d377d8f74 596
hagenrap 36:ba2e7eddbafa 597
hagenrap 36:ba2e7eddbafa 598 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 599 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 600 DisplaySendeString("Modus: SOLO-Betrieb");
hagenrap 36:ba2e7eddbafa 601 if(material == 1) {
hagenrap 36:ba2e7eddbafa 602 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 603 DisplaySendeString("Start ABS");
hagenrap 36:ba2e7eddbafa 604 } else if(material == 0) {
hagenrap 36:ba2e7eddbafa 605 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 606 DisplaySendeString("Start PLA");
hagenrap 36:ba2e7eddbafa 607 }
hagenrap 36:ba2e7eddbafa 608
scherfa2 38:3776ee18e56f 609 if(SOLOButtonSTART == true) {
hagenrap 39:6cc9a40bc8a6 610
scherfa2 38:3776ee18e56f 611 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 612 //buttonAbbruch_pressed = false;
scherfa2 38:3776ee18e56f 613 //buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 614 material = !material;
hagenrap 36:ba2e7eddbafa 615 }
hagenrap 36:ba2e7eddbafa 616
hagenrap 36:ba2e7eddbafa 617
hagenrap 37:a74d377d8f74 618
scherfa2 38:3776ee18e56f 619 if(SOLOButtonSTART == true) {
hagenrap 39:6cc9a40bc8a6 620
scherfa2 38:3776ee18e56f 621 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 622 //buttonSTART_pressed = false;
scherfa2 38:3776ee18e56f 623 //buttonSTART_diable_cb();
hagenrap 37:a74d377d8f74 624 //entry_SOLO_EinlegenOUT();
hagenrap 36:ba2e7eddbafa 625 entry_SOLO_EinlegenIN();
hagenrap 36:ba2e7eddbafa 626 }
hagenrap 37:a74d377d8f74 627
hagenrap 36:ba2e7eddbafa 628 break;
hagenrap 36:ba2e7eddbafa 629
hagenrap 36:ba2e7eddbafa 630
hagenrap 36:ba2e7eddbafa 631
hagenrap 36:ba2e7eddbafa 632
hagenrap 36:ba2e7eddbafa 633 case SOLO_EinlegenIN:
hagenrap 36:ba2e7eddbafa 634
hagenrap 36:ba2e7eddbafa 635 //Servo_Off();
hagenrap 36:ba2e7eddbafa 636
hagenrap 36:ba2e7eddbafa 637 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 638 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 639 DisplaySendeString("Filament rechts");
hagenrap 36:ba2e7eddbafa 640 gotoxy(1, 3);
hagenrap 36:ba2e7eddbafa 641 DisplaySendeString("einlegen");
hagenrap 36:ba2e7eddbafa 642 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 643 DisplaySendeString(" Abbruch");
hagenrap 36:ba2e7eddbafa 644
hagenrap 36:ba2e7eddbafa 645
scherfa2 38:3776ee18e56f 646 if(SOLOButtonSTART == true) {
scherfa2 38:3776ee18e56f 647 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 648 //buttonAbbruch_pressed = false;
scherfa2 38:3776ee18e56f 649 //buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 650 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 651 }
hagenrap 36:ba2e7eddbafa 652
hagenrap 36:ba2e7eddbafa 653 zeit = machNichts.read();
hagenrap 36:ba2e7eddbafa 654 if(zeit >= WARTEZEIT) {
hagenrap 36:ba2e7eddbafa 655
hagenrap 36:ba2e7eddbafa 656 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 657 }
hagenrap 36:ba2e7eddbafa 658
hagenrap 36:ba2e7eddbafa 659
hagenrap 36:ba2e7eddbafa 660 val_LS2 = LS_2.read();
hagenrap 36:ba2e7eddbafa 661 if(val_LS2 == 1) {
hagenrap 37:a74d377d8f74 662 Stepper_1_Run('V', 100);
hagenrap 36:ba2e7eddbafa 663 } else if (val_LS2 == 0) {
hagenrap 36:ba2e7eddbafa 664 Stepper_1_Stop();
hagenrap 36:ba2e7eddbafa 665 entry_SOLO_INtoSPLEISSER();
hagenrap 36:ba2e7eddbafa 666 }
hagenrap 36:ba2e7eddbafa 667
hagenrap 36:ba2e7eddbafa 668 break;
hagenrap 36:ba2e7eddbafa 669
hagenrap 36:ba2e7eddbafa 670
hagenrap 36:ba2e7eddbafa 671
hagenrap 36:ba2e7eddbafa 672
hagenrap 36:ba2e7eddbafa 673 case SOLO_INtoSPLEISSER:
hagenrap 36:ba2e7eddbafa 674 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 675 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 676 DisplaySendeString("Filament rechts");
hagenrap 36:ba2e7eddbafa 677 gotoxy(1, 3);
hagenrap 36:ba2e7eddbafa 678 DisplaySendeString("bereit");
hagenrap 36:ba2e7eddbafa 679 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 680 DisplaySendeString("Weiter Abbruch");
hagenrap 36:ba2e7eddbafa 681
hagenrap 36:ba2e7eddbafa 682 zeit = machNichts.read();
hagenrap 36:ba2e7eddbafa 683 if(zeit >= WARTEZEIT) {
hagenrap 36:ba2e7eddbafa 684
hagenrap 36:ba2e7eddbafa 685 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 686 }
hagenrap 35:758191d5c6e1 687
scherfa2 38:3776ee18e56f 688 if(SOLOButtonSTART == true) {
scherfa2 38:3776ee18e56f 689 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 690 //buttonAbbruch_pressed = false;
scherfa2 38:3776ee18e56f 691 //buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 692 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 693 }
hagenrap 36:ba2e7eddbafa 694
scherfa2 38:3776ee18e56f 695 if(SOLOButtonSTART == true) {
scherfa2 38:3776ee18e56f 696 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 697 //buttonSTART_pressed = false;
scherfa2 38:3776ee18e56f 698 //buttonSTART_diable_cb();
hagenrap 36:ba2e7eddbafa 699 entry_SOLO_EinlegenOUT();
hagenrap 36:ba2e7eddbafa 700 }
hagenrap 36:ba2e7eddbafa 701
hagenrap 36:ba2e7eddbafa 702 break;
hagenrap 36:ba2e7eddbafa 703
hagenrap 36:ba2e7eddbafa 704 case SOLO_EinlegenOUT:
hagenrap 36:ba2e7eddbafa 705 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 706 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 707 DisplaySendeString("Filament links");
hagenrap 36:ba2e7eddbafa 708 gotoxy(1, 3);
hagenrap 36:ba2e7eddbafa 709 DisplaySendeString("einlegen");
hagenrap 36:ba2e7eddbafa 710 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 711 DisplaySendeString(" Abbruch");
hagenrap 36:ba2e7eddbafa 712
scherfa2 38:3776ee18e56f 713 if(SOLOButtonSTART == true) {
scherfa2 38:3776ee18e56f 714 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 715 //buttonAbbruch_pressed = false;
scherfa2 38:3776ee18e56f 716 //buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 717 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 718 }
hagenrap 36:ba2e7eddbafa 719
hagenrap 36:ba2e7eddbafa 720 zeit = machNichts.read();
hagenrap 36:ba2e7eddbafa 721 if(zeit >= WARTEZEIT) {
hagenrap 36:ba2e7eddbafa 722
hagenrap 36:ba2e7eddbafa 723 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 724 }
hagenrap 36:ba2e7eddbafa 725
hagenrap 36:ba2e7eddbafa 726 val_LS3 = LS_3.read();
hagenrap 36:ba2e7eddbafa 727 if(val_LS3 == 1) {
hagenrap 37:a74d377d8f74 728 Stepper_2_Run('R', 100); /// das isch no Scheisse
hagenrap 36:ba2e7eddbafa 729 } else if (val_LS3 == 0) {
hagenrap 37:a74d377d8f74 730 Stepper_2_Stop();
hagenrap 36:ba2e7eddbafa 731 entry_SOLO_OUTtoSPLEISSER();
hagenrap 36:ba2e7eddbafa 732 }
hagenrap 36:ba2e7eddbafa 733 break;
hagenrap 36:ba2e7eddbafa 734
hagenrap 36:ba2e7eddbafa 735 case SOLO_OUTtoSPLEISSER:
hagenrap 36:ba2e7eddbafa 736 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 737 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 738 DisplaySendeString("Filament links");
hagenrap 36:ba2e7eddbafa 739 gotoxy(1, 3);
hagenrap 36:ba2e7eddbafa 740 DisplaySendeString("bereit");
hagenrap 36:ba2e7eddbafa 741 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 742 DisplaySendeString("Spleissen Abbruch");
hagenrap 36:ba2e7eddbafa 743
hagenrap 36:ba2e7eddbafa 744 zeit = machNichts.read();
hagenrap 36:ba2e7eddbafa 745 if(zeit >= WARTEZEIT) {
hagenrap 36:ba2e7eddbafa 746
hagenrap 36:ba2e7eddbafa 747 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 748 }
hagenrap 36:ba2e7eddbafa 749
scherfa2 38:3776ee18e56f 750 if(SOLOButtonSTART == true) {
scherfa2 38:3776ee18e56f 751 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 752 //buttonAbbruch_pressed = false;
scherfa2 38:3776ee18e56f 753 //buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 754 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 755 }
hagenrap 36:ba2e7eddbafa 756
scherfa2 38:3776ee18e56f 757 if(SOLOButtonSTART == true) {
scherfa2 38:3776ee18e56f 758 SOLOButtonSTART = false;
scherfa2 38:3776ee18e56f 759 // buttonSTART_pressed = false;
scherfa2 38:3776ee18e56f 760 // buttonSTART_diable_cb();
hagenrap 36:ba2e7eddbafa 761 entry_SOLO_Spleissen();
hagenrap 36:ba2e7eddbafa 762 }
hagenrap 36:ba2e7eddbafa 763 break;
hagenrap 36:ba2e7eddbafa 764
hagenrap 36:ba2e7eddbafa 765 case SOLO_Spleissen:
hagenrap 37:a74d377d8f74 766
hagenrap 37:a74d377d8f74 767 //DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 768 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 769 DisplaySendeString("Spleissen");
hagenrap 36:ba2e7eddbafa 770 gotoxy(1, 3);
hagenrap 37:a74d377d8f74 771 DisplaySendeString("Spleissen");
hagenrap 37:a74d377d8f74 772
hagenrap 37:a74d377d8f74 773
hagenrap 37:a74d377d8f74 774 motors[1]->set_max_speed(50);
hagenrap 37:a74d377d8f74 775 //motors[1]->set_acceleration(5);
hagenrap 37:a74d377d8f74 776 Stepper_2_Move('R', 1.3*400);
hagenrap 37:a74d377d8f74 777 StatusSOLO = SOLO_FERTIG;
hagenrap 37:a74d377d8f74 778
hagenrap 36:ba2e7eddbafa 779 break;
hagenrap 36:ba2e7eddbafa 780
hagenrap 36:ba2e7eddbafa 781 case SOLO_FERTIG:
hagenrap 37:a74d377d8f74 782
hagenrap 37:a74d377d8f74 783 motors[1]->set_max_speed(50);
hagenrap 37:a74d377d8f74 784 motors[1]->set_acceleration(10);
hagenrap 37:a74d377d8f74 785 motors[0]->set_max_speed(55);
hagenrap 37:a74d377d8f74 786 motors[0]->set_acceleration(10);
hagenrap 37:a74d377d8f74 787
hagenrap 37:a74d377d8f74 788 //motors[0]->move(StepperMotor::FWD, 0.2*400*128);
hagenrap 37:a74d377d8f74 789 motors[1]->move(StepperMotor::FWD, 0.05*400*128);
hagenrap 39:6cc9a40bc8a6 790
hagenrap 37:a74d377d8f74 791 //Set_Cutter(400, 200, 4);
hagenrap 37:a74d377d8f74 792
hagenrap 37:a74d377d8f74 793 motors[1]->wait_while_active();
hagenrap 37:a74d377d8f74 794
hagenrap 39:6cc9a40bc8a6 795
hagenrap 37:a74d377d8f74 796
hagenrap 37:a74d377d8f74 797 motors[1]->set_max_speed(300);
hagenrap 37:a74d377d8f74 798 motors[1]->set_acceleration(300);
hagenrap 37:a74d377d8f74 799 motors[0]->set_max_speed(400);
hagenrap 37:a74d377d8f74 800 motors[0]->set_acceleration(400);
hagenrap 37:a74d377d8f74 801
hagenrap 37:a74d377d8f74 802 motors[0]->move(StepperMotor::FWD, 1.2*400*128);
hagenrap 37:a74d377d8f74 803 motors[1]->move(StepperMotor::FWD, 1*400*128);
hagenrap 37:a74d377d8f74 804 motors[1]->wait_while_active();
hagenrap 37:a74d377d8f74 805 Stepper_2_Leerlauf();
hagenrap 39:6cc9a40bc8a6 806
hagenrap 37:a74d377d8f74 807 motors[0]->perform_prepared_actions();
hagenrap 37:a74d377d8f74 808 motors2[0]->perform_prepared_actions();
hagenrap 39:6cc9a40bc8a6 809
hagenrap 37:a74d377d8f74 810
hagenrap 37:a74d377d8f74 811
hagenrap 37:a74d377d8f74 812
hagenrap 37:a74d377d8f74 813
hagenrap 37:a74d377d8f74 814 //motors2[0]->perform_prepared_actions();
hagenrap 37:a74d377d8f74 815
hagenrap 37:a74d377d8f74 816 //Stepper_3_Move('V', 1.3*400);
hagenrap 37:a74d377d8f74 817
hagenrap 37:a74d377d8f74 818
hagenrap 37:a74d377d8f74 819 StatusSOLO = SOLO_STOERUNG;
hagenrap 36:ba2e7eddbafa 820 break;
hagenrap 36:ba2e7eddbafa 821
hagenrap 36:ba2e7eddbafa 822 case SOLO_STOERUNG:
hagenrap 37:a74d377d8f74 823 gotoxy(1, 1);
hagenrap 37:a74d377d8f74 824 DisplaySendeString("fertigfertig");
hagenrap 37:a74d377d8f74 825 gotoxy(1, 3);
hagenrap 37:a74d377d8f74 826 DisplaySendeString("fertigfertig");
hagenrap 36:ba2e7eddbafa 827 break;
hagenrap 36:ba2e7eddbafa 828
hagenrap 36:ba2e7eddbafa 829 }
scherfa2 27:23bd03a6a6f6 830 }
hagenrap 39:6cc9a40bc8a6 831 */