Fixed comments 1,2
Reduced a few log levels in ODE and XML reader
Initial change based on comment 4, showing minor inconsistency
Reverted changes to COM offsets
Rewrote GetLinkForceTorque to use GetJointForceTorque