mirror of https://github.com/ArduPilot/ardupilot
parent
38031edc9d
commit
8b6ad6d559
|
@ -121,7 +121,6 @@ AP_AHRS_DCM::check_matrix(void)
|
|||
{
|
||||
if (_dcm_matrix.is_nan()) {
|
||||
//Serial.printf("ERROR: DCM matrix NAN\n");
|
||||
SITL_debug("ERROR: DCM matrix NAN\n");
|
||||
renorm_blowup_count++;
|
||||
reset(true);
|
||||
return;
|
||||
|
@ -142,8 +141,6 @@ AP_AHRS_DCM::check_matrix(void)
|
|||
// in real trouble. All we can do is reset
|
||||
//Serial.printf("ERROR: DCM matrix error. _dcm_matrix.c.x=%f\n",
|
||||
// _dcm_matrix.c.x);
|
||||
SITL_debug("ERROR: DCM matrix error. _dcm_matrix.c.x=%f\n",
|
||||
_dcm_matrix.c.x);
|
||||
renorm_blowup_count++;
|
||||
reset(true);
|
||||
}
|
||||
|
@ -191,8 +188,6 @@ AP_AHRS_DCM::renorm(Vector3f const &a, Vector3f &result)
|
|||
// correction before we hit the ground!
|
||||
//Serial.printf("ERROR: DCM renormalisation error. renorm_val=%f\n",
|
||||
// renorm_val);
|
||||
SITL_debug("ERROR: DCM renormalisation error. renorm_val=%f\n",
|
||||
renorm_val);
|
||||
renorm_blowup_count++;
|
||||
return false;
|
||||
}
|
||||
|
|
|
@ -4,8 +4,6 @@
|
|||
|
||||
#include <avr/pgmspace.h>
|
||||
|
||||
#define SITL_debug(fmt, args ...)
|
||||
|
||||
// prog_char_t is used as a wrapper type for prog_char, which is
|
||||
// a character stored in flash. By using this wrapper type we can
|
||||
// auto-detect at compile time if a call to a string function is using
|
||||
|
|
|
@ -12,9 +12,5 @@
|
|||
#undef PROGMEM
|
||||
#define PROGMEM __attribute__(())
|
||||
|
||||
#undef SITL_debug
|
||||
#define SITL_debug(fmt, args ...) fprintf(stdout, "%s:%u " fmt, __FUNCTION__, __LINE__, ## args)
|
||||
|
||||
|
||||
#endif // __AP_PROGMEM_DESKTOP_BUILD_H__
|
||||
|
||||
|
|
|
@ -4,8 +4,6 @@
|
|||
|
||||
#include <string.h>
|
||||
|
||||
#define SITL_debug(fmt, args ...)
|
||||
|
||||
typedef char prog_char_t;
|
||||
typedef char prog_char;
|
||||
|
||||
|
|
Loading…
Reference in New Issue