hal_ano.h 1.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142
  1. //=============================================================================================
  2. // MahonyAHRS.h
  3. //=============================================================================================
  4. //
  5. // Madgwick's implementation of Mayhony's AHRS algorithm.
  6. // See: http://www.x-io.co.uk/open-source-imu-and-ahrs-algorithms/
  7. //
  8. // Date Author Notes
  9. // 29/09/2011 SOH Madgwick Initial release
  10. // 02/10/2011 SOH Madgwick Optimised for reduced CPU load
  11. //
  12. //=============================================================================================
  13. #ifndef _hal_ano_h
  14. #define _hal_ano_h
  15. #include <stdbool.h>
  16. #include <stdint.h>
  17. #include <string.h>
  18. #include "sdk_common.h"
  19. #include "SEGGER_RTT.h"
  20. #include "usr_config.h"
  21. #define ANO_COM_USR1 0xF1
  22. #define ANO_COM_USR2 0xF2
  23. #define ANO_COM_USR3 0xF3
  24. #define ANO_COM_USR4 0xF4
  25. #define ANO_COM_USR5 0xF5
  26. #define ANO_COM_USR6 0xF6
  27. #define ANO_COM_USR7 0xF7
  28. #define ANO_COM_USR8 0xF8
  29. #define ANO_COM_USR9 0xF9
  30. #define ANO_COM_USR10 0xFA
  31. void ANO_Send_Status(float rol,float pit,float yaw,int32_t hight,int8_t mode,int8_t lock,int8_t link);
  32. void ANO_Send_Senser(int16_t ax, int16_t ay, int16_t az, int16_t gx, int16_t gy, int16_t gz, int16_t mx, int16_t my, int16_t mz);
  33. void ANO_Send_RCData(int16_t thr, int16_t yaw, int16_t rol, int16_t pit, int16_t aux1, int16_t aux2, int16_t aux3, int16_t aux4, int16_t aux5, int16_t aux6);
  34. void ANO_Send_Distance(uint8_t num,int16_t dis1_100,int16_t dis2_100,int16_t dis3_100,int16_t dis4_100,int16_t dis5_100,int16_t dis6_100);
  35. void ANO_Send_Location(uint8_t num,int16_t locX_100,int16_t locY_100,int16_t locZ_100,int16_t locDX_100,int16_t locDY_100,int16_t locDZ_100);
  36. #endif