Cleaned up and fixed some functions
add new package cob_model_identifier
Add PID for each translatorial Axes
Add fixes provided by @ipa-fxm-fm
beautify
cleaning up
fixes + latest changes
add output publisher
add twist publisher script
merge with fxm-fm + clean up
missing include