Started working on Manual fly mode. B2 flies fine. Still needs to code up vacuum effects.