public double getError (PoseHandle pose)
		{
			return getCommand () - pose.get ().position.z;
		}
		public void getError (PoseHandle pose, ref double x, ref double y)
		{
			getCommand ( ref x, ref y );
			x -= pose.get ().position.x;
			y -= pose.get ().position.y;
		}