Added bugfixes with regards to preemption, resetting move base parameters every time etc