Added functions to compute desired motor side position and equivalent joints stiffness if elastic robot is considered
Added joint stiffness and rotor inertia from datasheet
Update