Fixed CmakeList files so code is detected on the robot