Things to change and modify

• Rename this to be more general
• Add an altitude to Vehicle
• filter should have its own noise model