Abort feature
Created by: MFernandezCarmona
Hi, I've implemented a behaviour in the robot that basically stops the movement and clears out whatever was remaining from the trajectory. This should be only used when the current trajectory is dangerous and needs to be stop and redone. I've only tested it on simulation, so all ideas are welcome. Maybe @ksatyaki could test it in Orebro to see how it goes on the real robots.