Added method to calculate total route distance.
Expanded state type to allow more options.
Expanded state type to allow more options.
Extended system state functionality.
Added functionality to state.
Enabled adding waypoints to the route.
Removed debugging logs.
Added logs.
Added ability to send arbitrary locations to the system.