Added more PID debug: all 4 motors and 3 axes rate
Debug total time to account for dropped log lines
Added even more PID debug