- Created rviz markers to show live vehicle shapes.
- Publish vehicle shapes.