Я бы также проверил, чтобы оптимизировать код, но зачем вам скорость выше 10 Гц?По моему мнению, вы могли бы просто написать лучший алгоритм «баланса», чтобы уменьшить потребность в более быстрой выборке.
Например, когда ваш робот скажет 5 градусов вправо, вы попытаетесь вместо этого исправить 4 градуса.и уменьшить необходимость повторной коррекции.Может быть, я ошибаюсь, но я тоже открыт для предложений!