Page 370 - MDP2022-2

HAL_GPIO_WritePin(GPIOD, dir1, GPIO_PIN_SET);
HAL_GPIO_WritePin(GPIOE, step1, GPIO_PIN_SET);
HAL_Delay(1);
HAL_GPIO_WritePin(GPIOE, step1, GPIO_PIN_RESET);
height--;
}
}
else if(status3 && !(status1 || status2)){
if(width > 0){
HAL_GPIO_WritePin(GPIOD, dir2, GPIO_PIN_RESET);
HAL_GPIO_WritePin(GPIOE, step2, GPIO_PIN_SET);
HAL_Delay(1);
HAL_GPIO_WritePin(GPIOE, step2, GPIO_PIN_RESET);
width--;
}
}

else if(status4 && !(status1 || status2)){
if(width < 1340){
HAL_GPIO_WritePin(GPIOD, dir2, GPIO_PIN_SET);
HAL_GPIO_WritePin(GPIOE, step2, GPIO_PIN_SET);
HAL_Delay(1);
HAL_GPIO_WritePin(GPIOE, step2, GPIO_PIN_RESET);
width++;
}
}
else if((status1 || status2) && (status3 || status4)){
if(status1 && height < 1340){ HAL_GPIO_WritePin(GPIOD, dir1, GPIO_PIN_RESET); height++;}
else if(status2 && height > 0){ HAL_GPIO_WritePin(GPIOD, dir1, GPIO_PIN_SET); height--;}

if(status3 && width > 0){ HAL_GPIO_WritePin(GPIOD, dir2, GPIO_PIN_RESET); width--;}
else if(status4 && width < 1340){ HAL_GPIO_WritePin(GPIOD, dir2, GPIO_PIN_SET), width++;}

if(height > 0 && height < 1340) HAL_GPIO_WritePin(GPIOE, step1, GPIO_PIN_SET);
if(width > 0 && width < 1340) HAL_GPIO_WritePin(GPIOE, step2, GPIO_PIN_SET);
}
HAL_GPIO_WritePin(GPIOE, step1, GPIO_PIN_RESET);
HAL_GPIO_WritePin(GPIOE, step2, GPIO_PIN_RESET);
HAL_Delay(1);
//dir D13 12 11 //step E12 14 15 //con F3 15 11 E0 10
if(HAL_GPIO_ReadPin(GPIOE, drop)){
for(int i = 0; i < 1400; i++){
HAL_GPIO_WritePin(GPIOD, dir3, GPIO_PIN_RESET);
HAL_GPIO_WritePin(GPIOE, step3, GPIO_PIN_SET);
HAL_Delay(1);