Code is now working for a n-body system.

New function introduced; calculates force, energy and angular momentum.
Allows to compute the differential equations and energy in one step
rather than two.

May want to check where the origin is - CoM?