Planning and Control for Quadrotor Flight through Cluttered