Mostly working, still needs goal find timeout, wheel broken.