process_result.h 1.8 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970
  1. #ifndef _PRECESS_RESULT_H_
  2. #define _PRECESS_RESULT_H_
  3. #include "main.h"
  4. #include "host_shoes.h"
  5. #include "slave_shoes.h"
  6. #include "send_data.h"
  7. //#define WHITE_SH0
  8. //#define BLUE_SHO
  9. #define BLUE_SH1
  10. #ifdef WHITE_SH0
  11. #if IS_HOST
  12. float accBias[3] = { -0.0046f, 0.0111f, -0.0061f};
  13. float accScale[3] = {1.0010f, 0.9996f, 0.9927f};
  14. float magBias[3] = { -34.0845f, -274.1449f, -83.0503f};
  15. float magScale[3] = { 0.0039f, 0.0042f, 0.0036f};
  16. #else
  17. /* slave*/
  18. float accBias[3] = {-0.0021f, 0.0031f, 0.0087f};
  19. float accScale[3] = {1.0001f, 1.0007f, 0.9921f};
  20. float magBias[3] = {-35.3160f, 86.2594f, -182.4592f};
  21. float magScale[3] = {0.0041f, 0.0039f, 0.0032f};
  22. #endif
  23. #elif defined BLUE_SHO
  24. #if IS_HOST
  25. float accBias[3] = { -0.0118f , 0.0130f , -0.0026f};
  26. float accScale[3] = {1.0015f , 1.0011f , 0.9896f};
  27. float magBias[3] = { 569.5943f , 271.8484f , 298.8276f};
  28. float magScale[3] = {0.0040f , 0.0037f , 0.0039f};
  29. #else
  30. /* slave*/
  31. float accBias[3] = {-0.0299f, 0.0114f , -0.0716f};
  32. float accScale[3] = {1.0017f, 1.0023f, 0.9884f};
  33. float magBias[3] = {324.02837f, 599.89072f, -1323.1148f};
  34. float magScale[3] = {0.0039f, 0.0037f, 0.0037f};
  35. #endif
  36. #elif defined BLUE_SH1
  37. #if IS_HOST
  38. float accBias[3] = { 0.0208f, 0.0066f, -0.0281f,};
  39. float accScale[3] = {1.0011f, 1.0004f, 0.9955f,};
  40. float magBias[3] = { 63.2058f , 113.6578f , -539.3837f};
  41. float magScale[3] = {0.0038f , 0.0038f , 0.0037f,};
  42. #else
  43. /* slave*/
  44. float accBias[3] = { -0.0055f, 0.0097f, -0.0550f};
  45. float accScale[3] = {1.0004f, 0.9991f, 1.0000f};
  46. float magBias[3] = {-80.7255f, 715.1156f, -870.1321f};
  47. float magScale[3] = {0.0037f, 0.0038f, 0.0036f};
  48. #endif
  49. #endif
  50. #endif