Adaptive test2.
Improved grabbing routeen with sensors (file test2) and restructured.