Now drawing the anchor point in the debug draw for the formation. Also played with the constants a bit.