added fril_tests
added lwr joint controller by torque
finished joint control by torque