add pwm interface initialization when calling method addJoints
fix little bug in encoder estimate reading