Some bugs were fixed. Such as reading values of wrong IR sensors.

Some comments to be discussed later are added

The next step is to control while following the wall