Finished catkinizing, added a cmake file to find flycap2. Will finish debugging tomorrow