Incorporated clustering and data assimilation into cup model.  Highly accurate result but could be issues with more than 3 cups due to occlusion