diff --git a/Arduino/MycobotBasic/examples/MoveToCoords/MoveToCoords.ino b/Arduino/MycobotBasic/examples/MoveToCoords/MoveToCoords.ino deleted file mode 100644 index e0b5ff1..0000000 --- a/Arduino/MycobotBasic/examples/MoveToCoords/MoveToCoords.ino +++ /dev/null @@ -1,46 +0,0 @@ -#include - -MycobotBasic myCobot; - -double one_PI = 90; // 180 degree -double half_PI = 45; // 90 degree - -// setup 6 points with coords - xyz(mm) and euler angles(radian) -double points[6][6] = {{-80.2, -100.8, 260.3, 0.0,0.0,0.0}, - {30.3, -170.4, 230.5, half_PI, one_PI, 0.0}, - {-21.6, 43.7, 307.8, -half_PI, 0, one_PI}, - {78.9, -102.1, 277.2, half_PI, half_PI, half_PI}, - {168.3, 20.3, 231.7, -half_PI, -half_PI, 0.0}, - {-128.4, 30.3, 233.4, half_PI, 0.0, -half_PI}}; - -void setup() { - myCobot.setup(); - Serial.begin(9600); - Serial.flush(); -} - -void loop() { - Serial.println("point 0"); - int sp = 60; //set move speed - // Move to Angle - Angles angles; - for ( auto &val : angles) - val = 0.0; - myCobot.writeAngles(angles, sp); - delay(5000); - // Move to Coords 6 points - for(int j = 0; j < 6; ++j) - { - Serial.print("point "); - Serial.println(j + 1); - Coords coords; - for(int i = 0; i < 6; ++i){ - coords[i] = points[j][i]; - } - myCobot.writeCoords(coords, sp); - delay(3000); - } - - - -}