add planning + controller (test)