Initial implementation of single constraint.
Added toString utility to vector.
Precorrect radius. Still not working...
Doing something, but force isn't compensating properly.