Tricycle.h 974 B

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152
  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. float calHeadingOffset(float init_heading, float cur_heading);
  11. private:
  12. int left_result;
  13. int right_result;
  14. int left_zupt_count;
  15. int right_zupt_count;
  16. float left_foot_init_heading;
  17. float right_foot_init_heading;
  18. int left_trigger_time;
  19. int right_trigger_time;
  20. int last_left_zupt;
  21. int last_right_zupt;
  22. int last_left_pos[3];
  23. int last_right_pos[3];
  24. int left_jump_status;
  25. int right_jump_status;
  26. int has_init;
  27. int left_pos_offset;
  28. int right_pos_offset;
  29. int last_jump;
  30. int prop_status;
  31. deque<int> left_acc_z_queue;
  32. deque<int> right_acc_z_queue;
  33. };