Integrated path and mapping code. It needs a LOT of calibration but holy crap it works.