PES_4_Spleisser / Mbed 2 deprecated SpleisserProgramm_V9

Update

Dependencies:   mbed mbed-rtos X_NUCLEO_IHM02A1

ST_SOLO.cpp@39:6cc9a40bc8a6, 2019-05-14 (annotated)

Committer:
hagenrap
Date:
Tue May 14 08:05:58 2019 +0000
Revision:
39:6cc9a40bc8a6
Parent:
38:3776ee18e56f
Child:
40:117b324843ee
Boot Screen, New Stepper Function, Splicer Function

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