Slam working well - managed to finish
Working well with wall following
Wall following working well after capping variance
Got rid of angle corrections as dont need them when full battery
Wroking well from point one
Ready for calibreation