Back to reading data from Kinect using read_data.cpp. Added shelf_objects.launch. Some minor changes in planner.cpp.