First commit

- MrBrian catkinized
- Fixed memory leak
- Fixed ambiguous grammar
- Fixed warnings
- Fixed checker compilation issues
- Fixed gmbte compilation issues