public override void Execute(IHardware d) { Console.WriteLine("Going to " + toPoint); Vector3 p = new Vector3(toPoint.X, toPoint.Y, toPoint.Z); d.GoTo(p, tool_speed); }