Initialize controller properly
Fixing planningtab
Update CMakeLists.txt