File Exchange

image thumbnail

Velocity-based dynamic model and adaptive controller for differential steered mobile robot

version 1.42 (124 KB) by Felipe Martins
Blocks for simulation of the differential steered (unicycle) mobile robot. Controllers included!

27 Downloads

Updated 04 Nov 2017

View License

These files allow the simulation of a differential steered (unicycle-like) mobile robot considering its complete dynamic model. The dynamic model here adopted is based on velocities (not torques), which makes it easier to integrate with existing mobile robot controllers that generate references for linear and angular velocities.
Although not required, the blocks were built to be compatible with Peter Corke's Robotics Toolbox, so the user can make use of the toolbox functions.
Sets of dynamic parameters are available for the following robots:
- Pioneer 3-DX with Sick LASER sensor;
- Pioneer 3-DX without LASER sensor;
- Pioneer 2 without on-board computer (no LASER sensor);
- Pioneer 2 with on-board computer (no LASER sensor);
- Robotic wheelchair carrying a 55kg person;
- Robotic wheelchair carrying a 125kg person;
- Khepera III (LAUT, 2011);
- RobuLAB-10 (SHOJAEI et al., 2011).

The files include two libraries:

- "DiffSteer_model.slx": contains the kinematic and dynamic blocks of the differential-drive mobile robot.

- "Controllers.slx": contains the following blocks:
a) trajectory tracking kinematic controller;
b) dynamic compensation controller 1;
c) dynamic compensation controller 2;
d) dynamic parameters estimator (for adaptive controllers);
e) trajectory generator;
f) performance calculator (IAE, ITAE, ISE, ITSE and energy indexes).

Four Simulink systems are provided as examples:

1. "kinematic_controller_system.slx": implements a simple trajectory tracking controller using both kinematic and dynamic blocks of the robot.

2. "dynamic_controller_system.slx": implements a more complex system that includes an adaptive dynamic compensation controller and the trajectory tracking controller with noisy sensor measurements.

Note: After running "kinematic_controller_system.slx" or "dynamic_controller_system.slx" simulations you can check the results running the included script "plot_results.m".

3. "sl_lanechange_unicycle.slx": implements the same system as the Robotics Toolbox "sl_lanechange", but using the kinematic model of the differential steered mobile robot.

4. "sl_lanechange_unicycle_dynamics.slx": implements the same system as the Robotics Toolbox "sl_lanechange", but using the kinematic and the dynamic models of the differential steered mobile robot.

Also, the following scripts are provided:

1. "sim_kin_controller.m": uses the "kinematic_controller_system.slx" system to simulate a kinematic trajectory tracking controller acting on a mobile robot (complete model).

2. "sim_dyn_controller.m": uses the "dynamic_controller_system.slx" system to simulate an adaptive dynamic compensation controller operating with the trajectory tracking controller acting on a mobile robot (complete model).

3. "plot_results.m" and "plot_results_kin.m": present the results of the simulations.

All blocks were tested in MATLAB R2012b, R2013a, R2014b, R2016a and 2017a, all under Windows.

Enjoy!

If you use this toolbox, please cite the following paper:

MARTINS, F. N., Sarcinelli-Filho, M. and Carelli, R.
A Velocity-Based Dynamic Model and Its Properties for Differential Drive Mobile Robots.
Journal of Intelligent & Robotic Systems, 2016.
http://rdcu.be/npvw

@article{martins2017velocity,
title={A Velocity-Based Dynamic Model and Its Properties for Differential Drive Mobile Robots},
author={Martins, Felipe N and Sarcinelli-Filho, M{\'a}rio and Carelli, Ricardo},
journal={Journal of Intelligent \& Robotic Systems},
volume={85},
number={2},
pages={277--292},
year={2017},
publisher={Springer}
}

Author: Felipe Nascimento Martins
https://about.me/felipe.n.martins

Based on a prior work by Felipe Nascimento Martins and Wanderley Cardoso Celeste
UFES - Federal University of Espirito Santo, BRAZIL
2006--2008

For more information, please refer to:

MARTINS, F. N., Celeste, W. C., Carelli, R., Sarcinelli-Filho, M. and
Bastos-Filho, T. F. An Adaptive Dynamic Controller for Autonomous Mobile Robot
Trajectory Tracking. Control Engineering Practice, v. 16, p. 1354–1363, 2008.
http://www.sciencedirect.com/science/article/pii/S0967066108000373

MARTINS, F. N. Modelagem e Compensacao da Dinamica de Robos Moveis e sua
Aplicacao em Controle de Formacao. Tese de Doutorado em Engenharia Eletrica - Automacao.
Universidade Federal do Espírito Santo, 2009.

LAUT, Jeffrey. A Dynamic Parameter Identification Method for Migrating Control Strategies
Between Heterogeneous Wheeled Mobile Robots. M.Sc. Diss. Worcester Polytechnic Institute, 2011.
https://www.semanticscholar.org/paper/A-Dynamic-Parameter-Identification-Method-for-Migr-Laut/000b0647483dad86a7cb6c51c25cff0e3219b633

SHOJAEI, Khoshnam et al. Adaptive trajectory tracking control of a differential drive wheeled mobile robot. Robotica, v. 29, n. 03, p. 391-402, 2011.

Comments and Ratings (6)

Vugar

Thank you!

Vugar

Hello, K.

The following are sets of identified parameters for some robots.

[0.2604 0.2509 -0.000499 0.9965 0.00263 1.0768]; % Pioneer 3DX with Sick LASER sensor
[0.5338 0.2168 -0.0134 0.9560 -0.0843 1.0590]; % Pioneer 3DX without LASER sensor
[0.2183 0.1918 -0.0050 0.9993 -0.0279 1.0142]; % Pioneer 3DX (identified by Jeffrey Laut)
[0.1992 0.13736 0.001954 0.9907 0.01554 0.9866]; % Pioneer 2 without onboard computer (no LASER sensor)
[0.3037 0.2768 -0.0004018 0.9835 0.003818 1.0725]; % Pioneer 2 with onboard computer (no LASER sensor)
[0.3759 0.0188 0.0128 1.0027 -0.0015 0.9808]; % Robotic wheelchair carring a 55kg person
[0.4263 0.0289 0.0058 0.9883 0.0134 0.9931]; % Robotic wheelchair carring a 125kg person
[0.0228 0.0568 -0.0001 1.0030 0.0732 0.9981]; % Khepera III (identified by Jeffrey Laut)

You can also check the dynamic parameters by clicking on the "help" option of the "DiffSteer Dynamics" block.

You can change the set of dynamic parameters by double-clicking on the "DiffSteer Dynamics" block and typing one of the above parameters on the appropriate box.

The procedure to identify the dynamic parameters for a given robot is described on the following references:

De La CRUZ, C., CARELLI, R. Dynamic model based formation control and obstacle avoidance of multi-robot systems. Robotica, n. 3, v. 26, p. 345--356, 2008.

LAUT, Jeffrey. A Dynamic Parameter Identification Method for Migrating Control Strategies Between Heterogeneous Wheeled Mobile Robots. M.Sc. Diss. Worcester Polytechnic Institute, 2011.

k

Can you please explain how I can select which dynamic is being used?
e.g. How can I change the dynamics between Pioneer 3DX and the Pioneer 2?

And thank you so much for sharing this models, amazing job.

Amine kamal

Thank you Prof. Martins for this file

Updates

1.42

Reference included on the description.

1.41.0.0

Toolbox description update only.

1.4.0.0

Update on description text, only.

1.4.0.0

- Included dynamic parameters of the RobuLAB-10 (SHOJAEI et al., 2011);
- Correction on the dynamic model block;
- New script files to assist simulations.

1.3.0.0

Content offered as a toolbox (.mltbx file) automatically created by the Mathworks website. I didn't test it because I still don't have access to MATLAB 2014b.

1.2.0.0

Included the dynamic parameters for the Khepera III mobile robot (identified by Jeffrey Laut).

1.1.0.0

Small corrections on the read_me.txt file.

MATLAB Release Compatibility
Created with R2017a
Compatible with any release
Platform Compatibility
Windows macOS Linux
Acknowledgements

Inspired: calculateEllipse(x, y, a, b, angle, steps)