Fixed a bug in simple_explorer were GP_left could not be initialized.
Controller now works with the previous values and containts the PID controller if needed for use. Also, the wallfollower2 has been reverted so it only uses the P-controller Christoffer made previously for testing.