Create some tests and CI workflow

## Feature request

Create some tests and CI workflow.

### Description

I think some kind of testing of this repo and CI would be a great addition.

### Implementation considerations

Initial GitHub action workflow PR: https://github.com/open-rmf/rmf_api_msgs/pull/28

