Fixed Hokuyo sensor (broken on last commit) and finished SLAM files