Planning made a bit faster with downsampled point cloud. Added basic overhead pick and place to execute plan. Now need to add more manipulation primitives in planning as well as manipulation.