Updated to work with changes to namespace (utils -> math).
Added example of planar linkage to test conservation of momentum.