This is a working version as far as planning is concerned. Tested by simulating moves generated by the planner. Planning is reasonably fast. Sampling includes different upright orientations now. Samples too close to other objects are rejected. Objects represented as bounding boxes as opposed to incomplete point clouds seen by the camera. DOES NOT keep track of seen areas over planning iterations though. Also needs a better logic for checking if the object is in front.