//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
//++++++++++++ Begin Serial Print Function +++++++++++++++++++
// Last Update: 13-01-2022
//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
void Printfunction()
{
// Serial.println(" ");
Serial.print(Loop_T_millis);
// Serial.print(" ");
// Serial.print(" G=");
// Serial.print(G_Value, 3);
Serial.print(" ");
// Serial.print(HomeIn_Switch);
// Serial.print(" ");
// Serial.print(" Flight-height [m]: ");
// Serial.print(Actual_flight_height,3);
// Serial.print("\t");
// Serial.print(" APtch=");
Serial.print(AccPitch, 1 );
Serial.print(" ");
// Serial.print(GyroPitch, 1);
// Serial.print(" ");
// Serial.print(" MxPtch=");
// Serial.print(MixPitch, 1);
// Serial.print("\t");
// Serial.print(" ARoll= ");
Serial.print(AccRoll, 1 );
Serial.print(" ");
// Serial.print(GyroRoll, 1);
// Serial.print(" ");
// Serial.print(" Mix-Roll= ");
// Serial.print(MixRoll, 1);
// Serial.print("\t");
/*
Serial.print("\t");
int hmax=180;
Serial.print(hmax);
Serial.print("\t");
int h1=90;
Serial.print(h1);
Serial.print("\t");
int h0=0;
Serial.print(h0);
Serial.print("\t");
int h2=-90;
Serial.print(h2);
Serial.print("\t");
int hmin=-180;
Serial.print(hmin);
Serial.print("\t");
*/
// YAW YAW YAW YAW YAW YAW YAW YAW
Serial.print(" GeoYaw= ");
Serial.print(GeoYaw, 1);
Serial.print(" ");
// Serial.print(MoveAvgMagYaw,1);
// Serial.print("\t");
// Serial.print(GyroYaw,1);
// Serial.print("\t");
// Serial.print(" Mix-Yaw= ");
// Serial.print("\t");
// Serial.print(MixYaw, 1);
/*
// Serial.print(" ESC_0= ");
Serial.print(" ");
Serial.print(ESC_0_In);
// Serial.print(" ESC_1= ");
Serial.print(" ");
Serial.print(ESC_1_In);
// Serial.print(" ESC_2= ");
Serial.print(" ");
Serial.print(ESC_2_In);
// Serial.print(" ESC_3= ");
Serial.print(" ");
Serial.print(ESC_3_In);
*/
// Serial.print(" ");
// Serial.print("pid_Pitch_output = ");
// Serial.print(Serial_Print_pid_pitch_output);
// Serial.print(pid_pitch_output);
// Serial.print(" ");
// Serial.print("pid_Roll_output = ");
// Serial.print(Serial_Print_pid_roll_output);
// Serial.print(pid_roll_output);
// Serial.print(" ");
// Serial.print("pid_Yaw_output = ");
// Serial.print(Serial_Print_pid_yaw_output);
Serial.println("");
}
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
//++++++++++++ End Serial Print Function +++++++++++++++++++
//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++