Learning to park

Position and orientation control on top of my speed controller.
I used the technique in this paper:
Y. Kanayama, Y. Kimura, F. Miyazaki, and T. Noguchi, ‘‘A stable tracking control method for an autonomous mobile robot,’’ Proc. IEEE Int. Conf. Rob. Autom., 1990, pp. 384-389.