Debug torques, fix mild issues with shoulder pos