Add linear/angular getters for spatial terms of BodyNode
Clean up BodyNode, SoftBodyNode, and Skeleton
Merge pull request #193 from dartsim/linear_angular

Add linear/angular getters for spatial terms of BodyNode