THeMIS UGV Intelligent Functions - Obstacle detection