PES_4_Spleisser / Mbed 2 deprecated SpleisserProgramm_V9

Update

Dependencies:   mbed mbed-rtos X_NUCLEO_IHM02A1

ST_SOLO.cpp@37:a74d377d8f74, 2019-05-10 (annotated)

Committer:
hagenrap
Date:
Fri May 10 17:31:36 2019 +0000
Revision:
37:a74d377d8f74
Parent:
36:ba2e7eddbafa
Child:
38:3776ee18e56f
spleisser probleme;

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 35:758191d5c6e1 69 extern PwmOut Servo;
hagenrap 35:758191d5c6e1 70 extern volatile bool buttonSTART_pressed;
hagenrap 35:758191d5c6e1 71 extern volatile bool buttonSTART_enabled;
scherfa2 27:23bd03a6a6f6 72
hagenrap 35:758191d5c6e1 73 extern volatile bool buttonAbbruch_pressed;
hagenrap 36:ba2e7eddbafa 74 extern volatile bool buttonAbbruch_enabled;
scherfa2 29:b84d0cc8bac8 75
hagenrap 35:758191d5c6e1 76 extern DigitalIn LS_1;
hagenrap 35:758191d5c6e1 77 extern DigitalIn LS_2;
hagenrap 35:758191d5c6e1 78 extern DigitalIn LS_3;
hagenrap 35:758191d5c6e1 79
hagenrap 37:a74d377d8f74 80 extern L6470 **motors;
hagenrap 37:a74d377d8f74 81 extern L6470B **motors2;
hagenrap 37:a74d377d8f74 82
hagenrap 37:a74d377d8f74 83 extern XNucleoIHM02A1 *x_nucleo_ihm02a1_1;
hagenrap 37:a74d377d8f74 84 extern XNucleoIHM02A12 *x_nucleo_ihm02a1_2;
hagenrap 35:758191d5c6e1 85
hagenrap 35:758191d5c6e1 86 extern DigitalIn mybutton;
hagenrap 35:758191d5c6e1 87
hagenrap 35:758191d5c6e1 88 extern PwmOut Cutter_1;
hagenrap 35:758191d5c6e1 89 extern PwmOut Cutter_2;
hagenrap 35:758191d5c6e1 90 extern PwmOut Spleisser_1;
hagenrap 35:758191d5c6e1 91 extern PwmOut Spleisser_2;
hagenrap 35:758191d5c6e1 92
hagenrap 36:ba2e7eddbafa 93 int material = 0;
hagenrap 36:ba2e7eddbafa 94 float zeit = 0;
hagenrap 36:ba2e7eddbafa 95 int val_LS1 = 0;
hagenrap 36:ba2e7eddbafa 96 int val_LS2 = 0;
hagenrap 36:ba2e7eddbafa 97 int val_LS3 = 0;
hagenrap 36:ba2e7eddbafa 98
hagenrap 37:a74d377d8f74 99 int count = 0;
hagenrap 37:a74d377d8f74 100
hagenrap 37:a74d377d8f74 101
hagenrap 36:ba2e7eddbafa 102 Timer machNichts;
hagenrap 36:ba2e7eddbafa 103
hagenrap 36:ba2e7eddbafa 104 void enable_Buttons()
hagenrap 36:ba2e7eddbafa 105 {
hagenrap 36:ba2e7eddbafa 106 buttonSTART_enabled_cb();
hagenrap 36:ba2e7eddbafa 107 buttonAbbruch_enabled_cb();
hagenrap 36:ba2e7eddbafa 108 }
hagenrap 36:ba2e7eddbafa 109
hagenrap 36:ba2e7eddbafa 110 void entry_SOLO_DEFAULT()
hagenrap 36:ba2e7eddbafa 111 {
hagenrap 36:ba2e7eddbafa 112 StatusSOLO = SOLO_DEFAULT;
hagenrap 37:a74d377d8f74 113 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 114 machNichts.stop();
hagenrap 36:ba2e7eddbafa 115 machNichts.reset();
hagenrap 36:ba2e7eddbafa 116 zeit = 0;
hagenrap 36:ba2e7eddbafa 117 val_LS1 = LS_1.read();
hagenrap 36:ba2e7eddbafa 118 if(val_LS1 == 0) {
hagenrap 36:ba2e7eddbafa 119 while(val_LS1 == 0) {
hagenrap 37:a74d377d8f74 120 Stepper_1_Run('R', 500);
hagenrap 36:ba2e7eddbafa 121 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 122 DisplaySendeString("ABBRUCH:");
hagenrap 36:ba2e7eddbafa 123 gotoxy(1, 2);
hagenrap 36:ba2e7eddbafa 124 DisplaySendeString("Filament rechts");
hagenrap 36:ba2e7eddbafa 125 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 126 DisplaySendeString("entfernen");
hagenrap 36:ba2e7eddbafa 127 val_LS1 = LS_1.read();
hagenrap 36:ba2e7eddbafa 128 }
hagenrap 36:ba2e7eddbafa 129 }
hagenrap 36:ba2e7eddbafa 130 val_LS3 = LS_3.read();
hagenrap 36:ba2e7eddbafa 131 if(val_LS3 == 0) {
hagenrap 36:ba2e7eddbafa 132 while(val_LS3 == 0) {
hagenrap 37:a74d377d8f74 133 Stepper_2_Run('V', 500);
hagenrap 36:ba2e7eddbafa 134 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 135 DisplaySendeString("ABBRUCH:");
hagenrap 36:ba2e7eddbafa 136 gotoxy(1, 2);
hagenrap 36:ba2e7eddbafa 137 DisplaySendeString("Filament links");
hagenrap 36:ba2e7eddbafa 138 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 139 DisplaySendeString("entfernen");
hagenrap 37:a74d377d8f74 140 val_LS3 = LS_3.read();
hagenrap 36:ba2e7eddbafa 141 }
hagenrap 36:ba2e7eddbafa 142 }
hagenrap 36:ba2e7eddbafa 143 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 144 }
hagenrap 36:ba2e7eddbafa 145
hagenrap 36:ba2e7eddbafa 146 void entry_SOLO_EinlegenIN()
hagenrap 36:ba2e7eddbafa 147 {
hagenrap 36:ba2e7eddbafa 148 StatusSOLO = SOLO_EinlegenIN;
hagenrap 36:ba2e7eddbafa 149 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 150 machNichts.start();
hagenrap 36:ba2e7eddbafa 151 Set_Servo_Good_Fil();
hagenrap 36:ba2e7eddbafa 152
hagenrap 36:ba2e7eddbafa 153 }
hagenrap 36:ba2e7eddbafa 154
hagenrap 36:ba2e7eddbafa 155 void entry_SOLO_INtoSPLEISSER()
hagenrap 36:ba2e7eddbafa 156 {
hagenrap 36:ba2e7eddbafa 157 StatusSOLO = SOLO_INtoSPLEISSER;
hagenrap 36:ba2e7eddbafa 158 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 159 machNichts.stop();
hagenrap 36:ba2e7eddbafa 160 machNichts.reset();
hagenrap 36:ba2e7eddbafa 161 zeit = 0;
hagenrap 36:ba2e7eddbafa 162 machNichts.start();
hagenrap 36:ba2e7eddbafa 163 enable_Buttons();
hagenrap 36:ba2e7eddbafa 164 }
hagenrap 36:ba2e7eddbafa 165
hagenrap 36:ba2e7eddbafa 166 void entry_SOLO_EinlegenOUT()
hagenrap 36:ba2e7eddbafa 167 {
hagenrap 36:ba2e7eddbafa 168 StatusSOLO = SOLO_EinlegenOUT;
hagenrap 36:ba2e7eddbafa 169 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 170 machNichts.stop();
hagenrap 36:ba2e7eddbafa 171 machNichts.reset();
hagenrap 36:ba2e7eddbafa 172 zeit = 0;
hagenrap 36:ba2e7eddbafa 173 machNichts.start();
hagenrap 36:ba2e7eddbafa 174 enable_Buttons();
hagenrap 36:ba2e7eddbafa 175 }
hagenrap 36:ba2e7eddbafa 176
hagenrap 36:ba2e7eddbafa 177 void entry_SOLO_OUTtoSPLEISSER()
hagenrap 36:ba2e7eddbafa 178 {
hagenrap 36:ba2e7eddbafa 179 StatusSOLO = SOLO_OUTtoSPLEISSER;
hagenrap 36:ba2e7eddbafa 180 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 181 machNichts.stop();
hagenrap 36:ba2e7eddbafa 182 machNichts.reset();
hagenrap 36:ba2e7eddbafa 183 zeit = 0;
hagenrap 36:ba2e7eddbafa 184 machNichts.start();
hagenrap 36:ba2e7eddbafa 185 enable_Buttons();
hagenrap 36:ba2e7eddbafa 186 }
hagenrap 36:ba2e7eddbafa 187
hagenrap 36:ba2e7eddbafa 188 void entry_SOLO_Spleissen()
hagenrap 36:ba2e7eddbafa 189 {
hagenrap 37:a74d377d8f74 190 DisplaySendeBefehl(0x01);
hagenrap 36:ba2e7eddbafa 191 StatusSOLO = SOLO_Spleissen;
hagenrap 36:ba2e7eddbafa 192 }
scherfa2 29:b84d0cc8bac8 193
scherfa2 27:23bd03a6a6f6 194 void EntrySOLO()
scherfa2 27:23bd03a6a6f6 195 {
hagenrap 36:ba2e7eddbafa 196 switch(StatusSOLO) {
hagenrap 36:ba2e7eddbafa 197 case SOLO_DEFAULT:
hagenrap 36:ba2e7eddbafa 198
hagenrap 36:ba2e7eddbafa 199 enable_Buttons();
hagenrap 36:ba2e7eddbafa 200
hagenrap 36:ba2e7eddbafa 201 Stepper_1_Leerlauf();
hagenrap 37:a74d377d8f74 202 Stepper_2_Leerlauf();
hagenrap 37:a74d377d8f74 203
hagenrap 36:ba2e7eddbafa 204
hagenrap 36:ba2e7eddbafa 205 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 206 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 207 DisplaySendeString("Modus: SOLO-Betrieb");
hagenrap 36:ba2e7eddbafa 208 if(material == 1) {
hagenrap 36:ba2e7eddbafa 209 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 210 DisplaySendeString("Start ABS");
hagenrap 36:ba2e7eddbafa 211 } else if(material == 0) {
hagenrap 36:ba2e7eddbafa 212 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 213 DisplaySendeString("Start PLA");
hagenrap 36:ba2e7eddbafa 214 }
hagenrap 36:ba2e7eddbafa 215
hagenrap 36:ba2e7eddbafa 216 if(buttonAbbruch_pressed == true) {
hagenrap 36:ba2e7eddbafa 217 buttonAbbruch_pressed = false;
hagenrap 36:ba2e7eddbafa 218 buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 219 material = !material;
hagenrap 36:ba2e7eddbafa 220 }
hagenrap 36:ba2e7eddbafa 221
hagenrap 36:ba2e7eddbafa 222
hagenrap 37:a74d377d8f74 223
hagenrap 36:ba2e7eddbafa 224 if(buttonSTART_pressed == true) {
hagenrap 36:ba2e7eddbafa 225 buttonSTART_pressed = false;
hagenrap 36:ba2e7eddbafa 226 buttonSTART_diable_cb();
hagenrap 37:a74d377d8f74 227 //entry_SOLO_EinlegenOUT();
hagenrap 36:ba2e7eddbafa 228 entry_SOLO_EinlegenIN();
hagenrap 36:ba2e7eddbafa 229 }
hagenrap 37:a74d377d8f74 230
hagenrap 36:ba2e7eddbafa 231 break;
hagenrap 36:ba2e7eddbafa 232
hagenrap 36:ba2e7eddbafa 233
hagenrap 36:ba2e7eddbafa 234
hagenrap 36:ba2e7eddbafa 235
hagenrap 36:ba2e7eddbafa 236 case SOLO_EinlegenIN:
hagenrap 36:ba2e7eddbafa 237
hagenrap 36:ba2e7eddbafa 238 //Servo_Off();
hagenrap 36:ba2e7eddbafa 239
hagenrap 36:ba2e7eddbafa 240 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 241 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 242 DisplaySendeString("Filament rechts");
hagenrap 36:ba2e7eddbafa 243 gotoxy(1, 3);
hagenrap 36:ba2e7eddbafa 244 DisplaySendeString("einlegen");
hagenrap 36:ba2e7eddbafa 245 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 246 DisplaySendeString(" Abbruch");
hagenrap 36:ba2e7eddbafa 247
hagenrap 36:ba2e7eddbafa 248
hagenrap 36:ba2e7eddbafa 249 if(buttonAbbruch_pressed == true) {
hagenrap 36:ba2e7eddbafa 250 buttonAbbruch_pressed = false;
hagenrap 36:ba2e7eddbafa 251 buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 252 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 253 }
hagenrap 36:ba2e7eddbafa 254
hagenrap 36:ba2e7eddbafa 255 zeit = machNichts.read();
hagenrap 36:ba2e7eddbafa 256 if(zeit >= WARTEZEIT) {
hagenrap 36:ba2e7eddbafa 257
hagenrap 36:ba2e7eddbafa 258 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 259 }
hagenrap 36:ba2e7eddbafa 260
hagenrap 36:ba2e7eddbafa 261
hagenrap 36:ba2e7eddbafa 262 val_LS2 = LS_2.read();
hagenrap 36:ba2e7eddbafa 263 if(val_LS2 == 1) {
hagenrap 37:a74d377d8f74 264 Stepper_1_Run('V', 100);
hagenrap 36:ba2e7eddbafa 265 } else if (val_LS2 == 0) {
hagenrap 36:ba2e7eddbafa 266 Stepper_1_Stop();
hagenrap 36:ba2e7eddbafa 267 entry_SOLO_INtoSPLEISSER();
hagenrap 36:ba2e7eddbafa 268 }
hagenrap 36:ba2e7eddbafa 269
hagenrap 36:ba2e7eddbafa 270 break;
hagenrap 36:ba2e7eddbafa 271
hagenrap 36:ba2e7eddbafa 272
hagenrap 36:ba2e7eddbafa 273
hagenrap 36:ba2e7eddbafa 274
hagenrap 36:ba2e7eddbafa 275 case SOLO_INtoSPLEISSER:
hagenrap 36:ba2e7eddbafa 276 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 277 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 278 DisplaySendeString("Filament rechts");
hagenrap 36:ba2e7eddbafa 279 gotoxy(1, 3);
hagenrap 36:ba2e7eddbafa 280 DisplaySendeString("bereit");
hagenrap 36:ba2e7eddbafa 281 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 282 DisplaySendeString("Weiter Abbruch");
hagenrap 36:ba2e7eddbafa 283
hagenrap 36:ba2e7eddbafa 284 zeit = machNichts.read();
hagenrap 36:ba2e7eddbafa 285 if(zeit >= WARTEZEIT) {
hagenrap 36:ba2e7eddbafa 286
hagenrap 36:ba2e7eddbafa 287 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 288 }
hagenrap 35:758191d5c6e1 289
hagenrap 36:ba2e7eddbafa 290 if(buttonAbbruch_pressed == true) {
hagenrap 36:ba2e7eddbafa 291 buttonAbbruch_pressed = false;
hagenrap 36:ba2e7eddbafa 292 buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 293 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 294 }
hagenrap 36:ba2e7eddbafa 295
hagenrap 36:ba2e7eddbafa 296 if(buttonSTART_pressed == true) {
hagenrap 36:ba2e7eddbafa 297 buttonSTART_pressed = false;
hagenrap 36:ba2e7eddbafa 298 buttonSTART_diable_cb();
hagenrap 36:ba2e7eddbafa 299 entry_SOLO_EinlegenOUT();
hagenrap 36:ba2e7eddbafa 300 }
hagenrap 36:ba2e7eddbafa 301
hagenrap 36:ba2e7eddbafa 302 break;
hagenrap 36:ba2e7eddbafa 303
hagenrap 36:ba2e7eddbafa 304 case SOLO_EinlegenOUT:
hagenrap 36:ba2e7eddbafa 305 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 306 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 307 DisplaySendeString("Filament links");
hagenrap 36:ba2e7eddbafa 308 gotoxy(1, 3);
hagenrap 36:ba2e7eddbafa 309 DisplaySendeString("einlegen");
hagenrap 36:ba2e7eddbafa 310 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 311 DisplaySendeString(" Abbruch");
hagenrap 36:ba2e7eddbafa 312
hagenrap 36:ba2e7eddbafa 313 if(buttonAbbruch_pressed == true) {
hagenrap 36:ba2e7eddbafa 314 buttonAbbruch_pressed = false;
hagenrap 36:ba2e7eddbafa 315 buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 316 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 317 }
hagenrap 36:ba2e7eddbafa 318
hagenrap 36:ba2e7eddbafa 319 zeit = machNichts.read();
hagenrap 36:ba2e7eddbafa 320 if(zeit >= WARTEZEIT) {
hagenrap 36:ba2e7eddbafa 321
hagenrap 36:ba2e7eddbafa 322 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 323 }
hagenrap 36:ba2e7eddbafa 324
hagenrap 36:ba2e7eddbafa 325 val_LS3 = LS_3.read();
hagenrap 36:ba2e7eddbafa 326 if(val_LS3 == 1) {
hagenrap 37:a74d377d8f74 327 Stepper_2_Run('R', 100); /// das isch no Scheisse
hagenrap 36:ba2e7eddbafa 328 } else if (val_LS3 == 0) {
hagenrap 37:a74d377d8f74 329 Stepper_2_Stop();
hagenrap 36:ba2e7eddbafa 330 entry_SOLO_OUTtoSPLEISSER();
hagenrap 36:ba2e7eddbafa 331 }
hagenrap 36:ba2e7eddbafa 332 break;
hagenrap 36:ba2e7eddbafa 333
hagenrap 36:ba2e7eddbafa 334 case SOLO_OUTtoSPLEISSER:
hagenrap 36:ba2e7eddbafa 335 DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 336 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 337 DisplaySendeString("Filament links");
hagenrap 36:ba2e7eddbafa 338 gotoxy(1, 3);
hagenrap 36:ba2e7eddbafa 339 DisplaySendeString("bereit");
hagenrap 36:ba2e7eddbafa 340 gotoxy(1, 4);
hagenrap 36:ba2e7eddbafa 341 DisplaySendeString("Spleissen Abbruch");
hagenrap 36:ba2e7eddbafa 342
hagenrap 36:ba2e7eddbafa 343 zeit = machNichts.read();
hagenrap 36:ba2e7eddbafa 344 if(zeit >= WARTEZEIT) {
hagenrap 36:ba2e7eddbafa 345
hagenrap 36:ba2e7eddbafa 346 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 347 }
hagenrap 36:ba2e7eddbafa 348
hagenrap 36:ba2e7eddbafa 349 if(buttonAbbruch_pressed == true) {
hagenrap 36:ba2e7eddbafa 350 buttonAbbruch_pressed = false;
hagenrap 36:ba2e7eddbafa 351 buttonAbbruch_diable_cb();
hagenrap 36:ba2e7eddbafa 352 entry_SOLO_DEFAULT();
hagenrap 36:ba2e7eddbafa 353 }
hagenrap 36:ba2e7eddbafa 354
hagenrap 36:ba2e7eddbafa 355 if(buttonSTART_pressed == true) {
hagenrap 36:ba2e7eddbafa 356 buttonSTART_pressed = false;
hagenrap 36:ba2e7eddbafa 357 buttonSTART_diable_cb();
hagenrap 36:ba2e7eddbafa 358 entry_SOLO_Spleissen();
hagenrap 36:ba2e7eddbafa 359 }
hagenrap 36:ba2e7eddbafa 360 break;
hagenrap 36:ba2e7eddbafa 361
hagenrap 36:ba2e7eddbafa 362 case SOLO_Spleissen:
hagenrap 37:a74d377d8f74 363
hagenrap 37:a74d377d8f74 364 //DisplaySendeBefehl(0x0C);
hagenrap 36:ba2e7eddbafa 365 gotoxy(1, 1);
hagenrap 36:ba2e7eddbafa 366 DisplaySendeString("Spleissen");
hagenrap 36:ba2e7eddbafa 367 gotoxy(1, 3);
hagenrap 37:a74d377d8f74 368 DisplaySendeString("Spleissen");
hagenrap 37:a74d377d8f74 369
hagenrap 37:a74d377d8f74 370
hagenrap 37:a74d377d8f74 371 motors[1]->set_max_speed(50);
hagenrap 37:a74d377d8f74 372 //motors[1]->set_acceleration(5);
hagenrap 37:a74d377d8f74 373 Stepper_2_Move('R', 1.3*400);
hagenrap 37:a74d377d8f74 374 StatusSOLO = SOLO_FERTIG;
hagenrap 37:a74d377d8f74 375
hagenrap 36:ba2e7eddbafa 376 break;
hagenrap 36:ba2e7eddbafa 377
hagenrap 36:ba2e7eddbafa 378 case SOLO_FERTIG:
hagenrap 37:a74d377d8f74 379
hagenrap 37:a74d377d8f74 380 motors[1]->set_max_speed(50);
hagenrap 37:a74d377d8f74 381 motors[1]->set_acceleration(10);
hagenrap 37:a74d377d8f74 382 motors[0]->set_max_speed(55);
hagenrap 37:a74d377d8f74 383 motors[0]->set_acceleration(10);
hagenrap 37:a74d377d8f74 384
hagenrap 37:a74d377d8f74 385 //motors[0]->move(StepperMotor::FWD, 0.2*400*128);
hagenrap 37:a74d377d8f74 386 motors[1]->move(StepperMotor::FWD, 0.05*400*128);
hagenrap 37:a74d377d8f74 387
hagenrap 37:a74d377d8f74 388 //Set_Cutter(400, 200, 4);
hagenrap 37:a74d377d8f74 389
hagenrap 37:a74d377d8f74 390 motors[1]->wait_while_active();
hagenrap 37:a74d377d8f74 391
hagenrap 37:a74d377d8f74 392
hagenrap 37:a74d377d8f74 393
hagenrap 37:a74d377d8f74 394 motors[1]->set_max_speed(300);
hagenrap 37:a74d377d8f74 395 motors[1]->set_acceleration(300);
hagenrap 37:a74d377d8f74 396 motors[0]->set_max_speed(400);
hagenrap 37:a74d377d8f74 397 motors[0]->set_acceleration(400);
hagenrap 37:a74d377d8f74 398
hagenrap 37:a74d377d8f74 399 motors[0]->move(StepperMotor::FWD, 1.2*400*128);
hagenrap 37:a74d377d8f74 400 motors[1]->move(StepperMotor::FWD, 1*400*128);
hagenrap 37:a74d377d8f74 401 motors[1]->wait_while_active();
hagenrap 37:a74d377d8f74 402 Stepper_2_Leerlauf();
hagenrap 37:a74d377d8f74 403 /*
hagenrap 37:a74d377d8f74 404 motors[0]->perform_prepared_actions();
hagenrap 37:a74d377d8f74 405 motors2[0]->perform_prepared_actions();
hagenrap 37:a74d377d8f74 406 */
hagenrap 37:a74d377d8f74 407
hagenrap 37:a74d377d8f74 408
hagenrap 37:a74d377d8f74 409
hagenrap 37:a74d377d8f74 410
hagenrap 37:a74d377d8f74 411 //motors2[0]->perform_prepared_actions();
hagenrap 37:a74d377d8f74 412
hagenrap 37:a74d377d8f74 413 //Stepper_3_Move('V', 1.3*400);
hagenrap 37:a74d377d8f74 414
hagenrap 37:a74d377d8f74 415
hagenrap 37:a74d377d8f74 416
hagenrap 37:a74d377d8f74 417
hagenrap 37:a74d377d8f74 418
hagenrap 37:a74d377d8f74 419 /*
hagenrap 37:a74d377d8f74 420 Stepper_3_Move('V', 1*400);
hagenrap 37:a74d377d8f74 421 Stepper_1_Move('V', 1*400);
hagenrap 37:a74d377d8f74 422 */
hagenrap 37:a74d377d8f74 423
hagenrap 37:a74d377d8f74 424 StatusSOLO = SOLO_STOERUNG;
hagenrap 36:ba2e7eddbafa 425 break;
hagenrap 36:ba2e7eddbafa 426
hagenrap 36:ba2e7eddbafa 427 case SOLO_STOERUNG:
hagenrap 37:a74d377d8f74 428 gotoxy(1, 1);
hagenrap 37:a74d377d8f74 429 DisplaySendeString("fertigfertig");
hagenrap 37:a74d377d8f74 430 gotoxy(1, 3);
hagenrap 37:a74d377d8f74 431 DisplaySendeString("fertigfertig");
hagenrap 36:ba2e7eddbafa 432 break;
hagenrap 36:ba2e7eddbafa 433
hagenrap 36:ba2e7eddbafa 434 }
scherfa2 27:23bd03a6a6f6 435 }
scherfa2 27:23bd03a6a6f6 436
scherfa2 27:23bd03a6a6f6 437