Started sorting c-functions into groups to avoid cluttering
Fixed errors in parent/children calculation of bodies
Updated README and example
Minor improvements