Visualisation for the human and equipment

Created nodes that subscribe to /saphari/human and /detect_equipment and publish the markers for the bodyparts and equipments to /visualisation_marker_array.
Assumes that there is only one equipment of one kind if there are two bowls only one would be displayed at a time.