3D-Position Tracking and Control for All-Terrain Robots