added timing to assemble
smaller robot shoulders
default stiffnesses for pids
enable/disable constraints
minor tweaks to pgs
added contact.Balance to track commonly used stuff
comments
added robot heading direction based on trunk
added tool.gravity