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; }
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; }