add generic storage function for header+3d ROS msg
switch everything to the generic data storage