Check if a point is inside this capsule.
A point is inside if its distance to the medial axis segment <= radius.
bool contains(Point p) { return _distanceToSegment(p) <= radius; }