Separate into a header and cpp file
Add private handle for the configuration
Split into NavSts and Odom policy
Keep noise in the model or fully leave it up to sensor simulations ?
Remove commented SimInterface code.
Deprecated world coordinate publishing in favor of the LLNode in labust_navigation.