Модель велосипедного транспортного средства
bicycleKinematics создание модели велосипедного транспортного средства для моделирования упрощенной автомобильной динамики транспортного средства. Данная модель представляет собой транспортное средство с двумя осями, разделенными расстоянием, А Base. Состояние транспортного средства определяется как трехэлементный вектор [x
y theta]
с глобальной xy-позицией, заданной в метрах, и углом тета курса транспортного средства, заданным в радианах. Переднее колесо может поворачиваться с углом поворота psi. Курс транспортного средства тета определяется в центре задней оси. Чтобы вычислить состояния производной по времени модели, используйте derivative функция с входными командами и текущим состоянием робота.
kinematicModel = bicycleKinematics
kinematicModel = bicycleKinematics(Name,Value)
derivative | Производная по времени от состояния транспортного средства |
Создание робота
Определите робота и задайте начальное начальное положение и ориентацию.
kinematicModel = bicycleKinematics; initialState = [0 0 0];
Моделирование движения робота
Установите временной интервал моделирования на 1 с с временными интервалами 0,05 с, а входные команды на 2 м/с и поворот влево. Моделирование движения робота с помощью ode45 решатель на derivative функция.
tspan = 0:0.05:1;
inputs = [2 pi/4]; %Turn left
[t,y] = ode45(@(t,y)derivative(kinematicModel,y,inputs),tspan,initialState);Траектория графика
figure plot(y(:,1),y(:,2))
[1] Линч, Кевин М. и Фрэнк К. Парк. Современная робототехника: механика, планирование и управление 1-й ред. Кембридж, Массачусетс: Cambridge University Press, 2017.
[2] Корк, Питер И. Робототехника, зрение и управление: фундаментальные алгоритмы в MATLAB. Спрингер, 2011.