flight module work continued

tested a couple of random values for P term of PID