intention_modelling.cpp subscribes to trajectory data