diff --git a/script/test_movement.py b/script/test_movement.py index 0ef12ad5..30bb34f5 100644 --- a/script/test_movement.py +++ b/script/test_movement.py @@ -1,8 +1,24 @@ -ManipulatorX.move(-3.8) -print("done") -#ManipulatorY -#ManipulatorZ -#ManipulatorTheta -#ManipulatorTilt -#ManipulatorPhi. \ No newline at end of file +class PhysicalLoction(): + def __init__(self, X, Y, Z, theta, tilt, phi): + self.X = X + self.Y = Y + self.Z = Z + self.theta = theta + self.tilt = tilt + self.phi = phi + + def move_to_location(self): + ManipulatorX.move(self.X) + ManipulatorY.move(self.Y) + ManipulatorZ.move(self.Z) + ManipulatorTheta.move(self.theta) + ManipulatorTilt.move(self.tilt) + ManipulatorPhi.move(self.phi) + +#VARS +sample = PhysicalLocation(-4.1,-0.5,115.1,51.0,0.8,-90) +goldReference = PhysicalLocation(-3.4,4.4,111.6,-8.8,0.7,90) + +goldReference.move_to_location() +