Add r/theta tracking box, fix error in  polar->motors function