Changed Herkulex baudrate to 666666 (max baudrate)