added wait for PID to initialize
fixed typo with PID power to arm
steaming piles of new code for 8916, no idea if it works