Active model learning and diverse action sampling for task and motion planning