use torque-vector instead of effort
delete codes that doesn't use