Added basic obstacle avoidance and ConfigurationParameters.h