Added configuration id commands to the sketch. Hopefully this might help with the forward/backward flight issue. If not will try to find another way to make this work.