Update PinConfig (BUild Board)
This commit is contained in:
@@ -9,30 +9,46 @@ void waitForUserInput() {
|
||||
}
|
||||
|
||||
void performGridCall(CoreXYMaschine * machine) {
|
||||
MotorPosition p0;
|
||||
MotorPosition p1;
|
||||
|
||||
machine->homeFast(&p0, false);
|
||||
printf("First Position\n");
|
||||
machine->setMotorEnabled(false);
|
||||
waitForUserInput();
|
||||
machine->setMotorEnabled(true);
|
||||
machine->homeFast(&p0, false);
|
||||
while (true) {
|
||||
|
||||
MotorPosition p0 = {.x=1296, .y=1802};
|
||||
MotorPosition p1 = {.x=16696, .y=18722};
|
||||
|
||||
printf("Second Position\n");
|
||||
machine->setMotorEnabled(false);
|
||||
waitForUserInput();
|
||||
machine->setMotorEnabled(true);
|
||||
machine->homeFast(&p1, false);
|
||||
// machine->homeFast(&p0, false);
|
||||
// printf("First Position\n");
|
||||
// machine->setMotorEnabled(false);
|
||||
// waitForUserInput();
|
||||
// machine->setMotorEnabled(true);
|
||||
// machine->homeFast(&p0, false);
|
||||
//
|
||||
// printf("Second Position\n");
|
||||
// machine->setMotorEnabled(false);
|
||||
// waitForUserInput();
|
||||
// machine->setMotorEnabled(true);
|
||||
// machine->homeFast(&p1, false);
|
||||
//
|
||||
// printf("First Position: %d, %d\n", p0.x, p0.y);
|
||||
// printf("Second Position: %d, %d\n", p1.x, p1.y);
|
||||
//
|
||||
BoardMessurements messurements = calcBoardMessurements(p0, p1, 19, 19);
|
||||
machine->setBoardMessurements(messurements);
|
||||
printf("Hi!\n");
|
||||
machine->home(NULL);
|
||||
waitForUserInput();
|
||||
machine->gotoPosition(10, 9);
|
||||
waitForUserInput();
|
||||
machine->gotoPosition(9, 10);
|
||||
waitForUserInput();
|
||||
machine->gotoPosition(8, 9);
|
||||
waitForUserInput();
|
||||
machine->gotoPosition(9, 8);
|
||||
waitForUserInput();
|
||||
machine->gotoPosition(10, 7);
|
||||
waitForUserInput();
|
||||
machine->home(NULL);
|
||||
}
|
||||
|
||||
printf("First Position: %d, %d\n", p0.x, p0.y);
|
||||
printf("Second Position: %d, %d\n", p1.x, p1.y);
|
||||
|
||||
BoardMessurements messurements = calcBoardMessurements(p0, p1, 19, 19);
|
||||
machine->setBoardMessurements(messurements);
|
||||
|
||||
machine->gotoPosition(15, 15);
|
||||
vTaskDelay(100 / portTICK_PERIOD_MS);
|
||||
//machine->gotoPosition(7, 6);
|
||||
|
||||
//for(int i = 0; i < 19; i++) {
|
||||
|
||||
Reference in New Issue
Block a user