modify herkulex.h and add softServo of wiringPi LIB