i see.  now I'm starting to understand. 
is there a simple change to the featherstone loop that would dramatically simplify this?

(i would have thought that all of this added mass stuff could have be accomplished by simply modifying the mass/inertia at load time :)