- Fix bugs
- Implement publishing of second sensor axes
- Optimize layout and code