Fixed bugs. Topic contains float64 x,y,z,roll,pitch,yaw