Add wall avoider
Avoids walls based on IR and Sonar sensor