12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152 |
- #include "PublicSDKMotion.h"
- #include "pub.h"
- class Tricycle : public PublicSDKMotion
- {
- public:
- Tricycle();
- 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,
- int* left_pos, int* left_att, int* left_acc, int left_zupt, int left_front_press, int left_back_press,
- int jump, int down, int rssi);
- float calHeadingOffset(float init_heading, float cur_heading);
- private:
- int left_result;
- int right_result;
- int left_zupt_count;
- int right_zupt_count;
- float left_foot_init_heading;
- float right_foot_init_heading;
- int left_trigger_time;
- int right_trigger_time;
- int last_left_zupt;
- int last_right_zupt;
- int last_left_pos[3];
- int last_right_pos[3];
- int left_jump_status;
- int right_jump_status;
- int has_init;
- int left_pos_offset;
- int right_pos_offset;
- int last_jump;
- int prop_status;
- deque<int> left_acc_z_queue;
- deque<int> right_acc_z_queue;
- };
|