-Added the Foot Constraint implementation, and added the basis for collision detection in the Line class