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