Add completed knot publisher
Merge remote-tracking branch 'origin/pvt_segment_mode' into sbpl