`Added ball roa code, fixed simTorso for new version of drake.