first version (still not compiling) of the new jointTorqueControl