Localization works, needs sensor cutoff for slight grid misalignment and a new bug that causes robot to freeze when turning