JumpHouse.h 1.2 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455
  1. #include "PublicSDKMotion.h"
  2. class JumpHouse : public PublicSDKMotion
  3. {
  4. public:
  5. JumpHouse();
  6. 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,
  7. int* left_pos, int* left_att, int* left_acc, int left_zupt, int left_front_press, int left_back_press,
  8. int jump, int down, int rssi);
  9. bool unzuptValid(int* max_acc, int* min_acc);
  10. private:
  11. deque<int> rssi_vec;
  12. deque<int> pitch_vec;
  13. deque<int> roll_vec;
  14. deque<int> left_acc_vec;
  15. deque<int> right_acc_vec;
  16. int pitch_reference_val = 0;
  17. int roll_reference_val = 0;
  18. int has_init = 0;
  19. deque<shoes_data_cell> left_shoes_data_vector;
  20. deque<shoes_data_cell> right_shoes_data_vector;
  21. deque<shoes_data_cell> left_step_data_vector;
  22. deque<shoes_data_cell> right_step_data_vector;
  23. int left_acc_buff[3][3];
  24. int right_acc_buff[3][3];
  25. deque<int> left_acc_x_vector;
  26. deque<int> right_acc_x_vector;
  27. float left_heading;
  28. float right_heading;
  29. int right_cmd_wait_time;
  30. int left_cmd_wait_time;
  31. int left_init;
  32. int right_init;
  33. int left_zupt_extension_time = 0;
  34. int right_zupt_extension_time = 0;
  35. const int rssi_threshold = 25;
  36. };