Fix typos in main and add debug information for test case 1.
Complete implementation of filter and robot. First test case working fine.
Add super dirty cmake lists.
Update gitignore with build dir.