Solved a bug: The current operational mode was not updated for extended register map servos.