Fixed headers to avoid recursive or conflicting references, created logging function work to be completed, moved inference functions to model class
Logger function now obtains planner and model information about positions, velocities, simulated velocities of modelled agents
Fixed bug where avg velocity was not used for preffered velocity simulation, now velocities are calculated as instantaneous velocities from previous positions vs current position, moving average for likelihood via inserting and resizing history vector