State Estimation and Optimal Control for Racing Drones