Looks pretty solid. I'm just skimming through it now and it looks great. It took me a while to figure out what exactly you were using the gear tooth sensor for and the lookup table confused me at first. I guess that's what I get for ignoring some comments
