Fix some small bugs for the fast plot program
Fix some small bugs for the fast plot program

Khan-drone/flight-control,Khan-drone/ahrs-core,Khan-drone/ahrs-core,Khan-drone/flight-control,Khan-drone/ahrs-core,Khan-drone/flight-control,Khan-drone/flight-control,Khan-drone/flight-control,Khan-drone/flight-control,Khan-drone/ahrs-core,Khan-drone/ahrs-core,Khan-drone/ahrs-core