Check camera util is initialized before publishing - fix from Atlas

This fix is copied from drcsim/Atlas:

*Fix gazebo (and ros image_transport) crashes due to image publication race condition. Happens when publishing image before params are initialized.*

See [bitbucket issue](https://bitbucket.org/osrf/drcsim/pull-request/353/check-camera-util-is-initialized-before/diff)