Fix publishing only top level model pose in pose publisher (#2697)

Fix publishing only top level model pose in pose publisher (#2697) #14675