Work on firefly test

- added firefly simulation test
- added launch file
- updated cmake