Revision history [back]

The posearray message structure in your update() method isn't the same as the local posearray message structure you declare and populate in calculate_boxes(). Instead of declaring a local geometry_msgs::PoseArray in calculate_boxes(), just add a pointer argument like you are already doing with your custom message. Then from update(), pass the pointer to the PoseArray you are actually publishing.