added code to remove points on the table and do simple icp