Proportional controller using torque control, first trial. Do not run this code. you might damage the fingers