Created more structs for passing packets between tasks. Removed
shared_queues.hpp and moved all shared structs and variables to
shared_handles.h. Optimized the tasks, and debugging.  optimized
Djikstras and added strip function, SM_pkt, and removed unused
variables. Changed how debug was used to prevent it from being compiled
when not used.