[demo] fix for demo

TODO fix tf transform for PoseNormStamped