Fixed small bug where publisher needs to check if it has been called
Moving includes to cpp