Change getting time from "time.time" to "header.stamp.time"
Changing position to new joint_states
New position including rotation ext_axis
Matlab small changes