Fix J1 and J2 not being filtered #62
Description
J1 and J2 positions are not being filtered. There's a difference in the way this is done in the transmission:
https://github.com/shadow-robot/sr_core/blob/indigo-devel/sr_mechanism_model/src/joint_0_transmission.cpp#L70
https://github.com/shadow-robot/sr_core/blob/indigo-devel/sr_mechanism_model/src/simple_transmission.cpp#L84