Транспортное средство с дифференциальным приводом
differentialDriveKinematics создает модель дифференциально-приводного транспортного средства для моделирования упрощенной динамики аппарата. Эта модель аппроксимирует транспортное средство с одной фиксированной осью и колесами, разделенными заданной шириной пути. Колеса могут вращаться независимо. Скорость и курс транспортного средства определяются из центра оси. Состояние транспортного средства определяется как трехэлементный вектор, [x y theta] с глобальным xy -положением, заданным в метрах, и курсом транспортного средства, theta, заданным в радианах. Чтобы вычислить состояния производной по времени для модели, используйте derivative функция с входными командами и текущим состоянием робота.
kinematicModel = differentialDriveKinematics
kinematicModel = differentialDriveKinematics(Name,Value)
derivative | Производная по времени от состояния транспортного средства |
Создайте робота
Определите робота и установите начальное начальное положение и ориентацию.
kinematicModel = differentialDriveKinematics; initialState = [0 0 0];
Симулируйте движение робота
Установите временной интервал симуляции 1 с с таймстепами 0,05 с, и входные команды 2 м/с и поворот влево. Симулируйте движение робота при помощи ode45 решатель на derivative функция.
tspan = 0:0.05:1;
inputs = [50 40]; %Left wheel is spinning faster
[t,y] = ode45(@(t,y)derivative(kinematicModel,y,inputs),tspan,initialState);Путь к графику
figure plot(y(:,1),y(:,2))
[1] Линч, Кевин М. и Фрэнк С. Парк. Современная робототехника: Механика, Планирование и Контроль 1 эд. Кембридж, Массачусетс: Cambridge University Press, 2017.