copied in changes from raven_2_vision in image_processing_packages
fixed print_state
merged raven_2_vision