Checks if distance between current and previous pose is above a threshold
Checks if distance and angle between current and previous pose is above a threshold
Checks if current pose is within goal window for x,y and yaw
Checks linear and angular velocity after stopping
Goal checker that only checks XY position and ignores orientation