added a circular test obstacle
extracted _getNormalOfPenetrationPoint for improved performance