Started to create new trajectory point publisher