getXYLength

Get the euclidean length of the XY component of the pose