Tricycle.h 968 B

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253
  1. #include "PublicSDKMotion.h"
  2. #include "pub.h"
  3. class Tricycle : public PublicSDKMotion
  4. {
  5. public:
  6. Tricycle();
  7. virtual void Process(int time_stamp, int* right_pos, int* right_att, int* right_acc, int right_zupt, int right_front_press, int right_back_press,
  8. int* left_pos, int* left_att, int* left_acc, int left_zupt, int left_front_press, int left_back_press,
  9. int jump, int down, int rssi);
  10. virtual void getResult(int* matrix);
  11. float calHeadingOffset(float init_heading, float cur_heading);
  12. private:
  13. int result[4];
  14. int left_result;
  15. int right_result;
  16. int left_zupt_count;
  17. int right_zupt_count;
  18. float left_foot_init_heading;
  19. float right_foot_init_heading;
  20. int left_trigger_time;
  21. int right_trigger_time;
  22. int last_left_zupt;
  23. int last_right_zupt;
  24. int last_left_pos[3];
  25. int last_right_pos[3];
  26. int left_jump_status;
  27. int right_jump_status;
  28. int has_init;
  29. int left_pos_offset;
  30. int right_pos_offset;
  31. int last_jump;
  32. int prop_status;
  33. };