PES_4_Spleisser / Mbed 2 deprecated SpleisserProgramm_V9

Update

Dependencies:   mbed mbed-rtos X_NUCLEO_IHM02A1

ST_SOLO.cpp@38:3776ee18e56f, 2019-05-13 (annotated)

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