Added empty function changeDir and added its call to the control loop
Cleaned up includeds.