Робот 4WD

Kvandaik
Offline
Зарегистрирован: 06.04.2017

Как можно запрограммировать разворот робота на 90 градусов имея только 2 ультразвуковых датчика на серво приводах стоящих спереди и сзади базы модели, база состоит из 4 х колёс с редукторами. Допустим робот доехал вдоль стены и остановился в углу (не плотно) см 30 от стен, нужно развернуть его на 90 градусов потом ещё на 90 как это сделать. Предполагается что ультразвуковые датчики на серово приводах смогут определять расстояние до стены и тем самым сравнить (если машинка стоит ровно то датчики смотрящие параллельно стене, показывают одинаковое расстояние +-5мм) происходит управление движками , идёт опрос от датчиков если поворот произведён на 90 то теоретически от другой стены до датчиков опять должно образоваться одинаковое расстояние( примечание если база длиннее то и датчики находятся дальше точность повышается)

nevkon
Offline
Зарегистрирован: 20.01.2015

Точно так же как пишется любая программа сложнее блинка.

1. Рисуется обобщенный алгоритм работы программы.

2. Рисуется подробный алгоритм, можно несколько - по одному на каждый блок.

3. Алгоритм переводится в программу.

Соответственно когда есть алгоритм проще будет понять где программа отработала неправильно.