intention_modelling.cpp subscibes to trajectory data