24 #include <interfaces/HumanSkeletonInterface.h>
26 #include <core/exceptions/software.h>
43 HumanSkeletonInterface::HumanSkeletonInterface() : Interface()
45 data_size =
sizeof(HumanSkeletonInterface_data_t);
47 data = (HumanSkeletonInterface_data_t *)
data_ptr;
151 unsigned char tmp_hash[] = {0x5f, 0x47, 0x2f, 0xb3, 0x8b, 0xf1, 0xe1, 0xa, 0xb9, 0x42, 0x34, 0xea, 0x83, 0x43, 0x94, 0x37};
156 HumanSkeletonInterface::~HumanSkeletonInterface()
168 case STATE_INVALID:
return "STATE_INVALID";
169 case STATE_DETECTING_POSE:
return "STATE_DETECTING_POSE";
170 case STATE_CALIBRATING:
return "STATE_CALIBRATING";
171 case STATE_TRACKING:
return "STATE_TRACKING";
172 default:
return "UNKNOWN";
203 data->state = new_state;
214 return data->user_id;
234 data->user_id = new_user_id;
251 return data->visibility_history;
277 data->visibility_history = new_visibility_history;
308 strncpy(data->pose, new_pose,
sizeof(data->pose));
332 throw Exception(
"Index value %u out of bounds (0..3)", index);
334 return data->com[index];
354 memcpy(data->com, new_com,
sizeof(
float) * 3);
367 throw Exception(
"Index value %u out of bounds (0..3)", index);
369 data->com[index] = new_com;
379 return data->pos_head;
392 throw Exception(
"Index value %u out of bounds (0..3)", index);
394 return data->pos_head[index];
414 memcpy(data->pos_head, new_pos_head,
sizeof(
float) * 3);
427 throw Exception(
"Index value %u out of bounds (0..3)", index);
429 data->pos_head[index] = new_pos_head;
440 return data->pos_head_confidence;
461 data->pos_head_confidence = new_pos_head_confidence;
472 return data->pos_neck;
485 throw Exception(
"Index value %u out of bounds (0..3)", index);
487 return data->pos_neck[index];
507 memcpy(data->pos_neck, new_pos_neck,
sizeof(
float) * 3);
520 throw Exception(
"Index value %u out of bounds (0..3)", index);
522 data->pos_neck[index] = new_pos_neck;
533 return data->pos_neck_confidence;
554 data->pos_neck_confidence = new_pos_neck_confidence;
565 return data->pos_torso;
578 throw Exception(
"Index value %u out of bounds (0..3)", index);
580 return data->pos_torso[index];
600 memcpy(data->pos_torso, new_pos_torso,
sizeof(
float) * 3);
613 throw Exception(
"Index value %u out of bounds (0..3)", index);
615 data->pos_torso[index] = new_pos_torso;
626 return data->pos_torso_confidence;
647 data->pos_torso_confidence = new_pos_torso_confidence;
658 return data->pos_waist;
671 throw Exception(
"Index value %u out of bounds (0..3)", index);
673 return data->pos_waist[index];
693 memcpy(data->pos_waist, new_pos_waist,
sizeof(
float) * 3);
706 throw Exception(
"Index value %u out of bounds (0..3)", index);
708 data->pos_waist[index] = new_pos_waist;
719 return data->pos_waist_confidence;
740 data->pos_waist_confidence = new_pos_waist_confidence;
752 return data->pos_left_collar;
766 throw Exception(
"Index value %u out of bounds (0..3)", index);
768 return data->pos_left_collar[index];
789 memcpy(data->pos_left_collar, new_pos_left_collar,
sizeof(
float) * 3);
803 throw Exception(
"Index value %u out of bounds (0..3)", index);
805 data->pos_left_collar[index] = new_pos_left_collar;
816 return data->pos_left_collar_confidence;
837 data->pos_left_collar_confidence = new_pos_left_collar_confidence;
849 return data->pos_left_shoulder;
863 throw Exception(
"Index value %u out of bounds (0..3)", index);
865 return data->pos_left_shoulder[index];
886 memcpy(data->pos_left_shoulder, new_pos_left_shoulder,
sizeof(
float) * 3);
900 throw Exception(
"Index value %u out of bounds (0..3)", index);
902 data->pos_left_shoulder[index] = new_pos_left_shoulder;
913 return data->pos_left_shoulder_confidence;
934 data->pos_left_shoulder_confidence = new_pos_left_shoulder_confidence;
946 return data->pos_left_elbow;
960 throw Exception(
"Index value %u out of bounds (0..3)", index);
962 return data->pos_left_elbow[index];
983 memcpy(data->pos_left_elbow, new_pos_left_elbow,
sizeof(
float) * 3);
997 throw Exception(
"Index value %u out of bounds (0..3)", index);
999 data->pos_left_elbow[index] = new_pos_left_elbow;
1010 return data->pos_left_elbow_confidence;
1031 data->pos_left_elbow_confidence = new_pos_left_elbow_confidence;
1043 return data->pos_left_wrist;
1057 throw Exception(
"Index value %u out of bounds (0..3)", index);
1059 return data->pos_left_wrist[index];
1080 memcpy(data->pos_left_wrist, new_pos_left_wrist,
sizeof(
float) * 3);
1094 throw Exception(
"Index value %u out of bounds (0..3)", index);
1096 data->pos_left_wrist[index] = new_pos_left_wrist;
1107 return data->pos_left_wrist_confidence;
1128 data->pos_left_wrist_confidence = new_pos_left_wrist_confidence;
1140 return data->pos_left_hand;
1154 throw Exception(
"Index value %u out of bounds (0..3)", index);
1156 return data->pos_left_hand[index];
1177 memcpy(data->pos_left_hand, new_pos_left_hand,
sizeof(
float) * 3);
1191 throw Exception(
"Index value %u out of bounds (0..3)", index);
1193 data->pos_left_hand[index] = new_pos_left_hand;
1204 return data->pos_left_hand_confidence;
1225 data->pos_left_hand_confidence = new_pos_left_hand_confidence;
1237 return data->pos_left_fingertip;
1251 throw Exception(
"Index value %u out of bounds (0..3)", index);
1253 return data->pos_left_fingertip[index];
1274 memcpy(data->pos_left_fingertip, new_pos_left_fingertip,
sizeof(
float) * 3);
1288 throw Exception(
"Index value %u out of bounds (0..3)", index);
1290 data->pos_left_fingertip[index] = new_pos_left_fingertip;
1301 return data->pos_left_fingertip_confidence;
1322 data->pos_left_fingertip_confidence = new_pos_left_fingertip_confidence;
1334 return data->pos_right_collar;
1348 throw Exception(
"Index value %u out of bounds (0..3)", index);
1350 return data->pos_right_collar[index];
1371 memcpy(data->pos_right_collar, new_pos_right_collar,
sizeof(
float) * 3);
1385 throw Exception(
"Index value %u out of bounds (0..3)", index);
1387 data->pos_right_collar[index] = new_pos_right_collar;
1398 return data->pos_right_collar_confidence;
1419 data->pos_right_collar_confidence = new_pos_right_collar_confidence;
1431 return data->pos_right_shoulder;
1445 throw Exception(
"Index value %u out of bounds (0..3)", index);
1447 return data->pos_right_shoulder[index];
1468 memcpy(data->pos_right_shoulder, new_pos_right_shoulder,
sizeof(
float) * 3);
1482 throw Exception(
"Index value %u out of bounds (0..3)", index);
1484 data->pos_right_shoulder[index] = new_pos_right_shoulder;
1495 return data->pos_right_shoulder_confidence;
1516 data->pos_right_shoulder_confidence = new_pos_right_shoulder_confidence;
1528 return data->pos_right_elbow;
1542 throw Exception(
"Index value %u out of bounds (0..3)", index);
1544 return data->pos_right_elbow[index];
1565 memcpy(data->pos_right_elbow, new_pos_right_elbow,
sizeof(
float) * 3);
1579 throw Exception(
"Index value %u out of bounds (0..3)", index);
1581 data->pos_right_elbow[index] = new_pos_right_elbow;
1592 return data->pos_right_elbow_confidence;
1613 data->pos_right_elbow_confidence = new_pos_right_elbow_confidence;
1625 return data->pos_right_wrist;
1639 throw Exception(
"Index value %u out of bounds (0..3)", index);
1641 return data->pos_right_wrist[index];
1662 memcpy(data->pos_right_wrist, new_pos_right_wrist,
sizeof(
float) * 3);
1676 throw Exception(
"Index value %u out of bounds (0..3)", index);
1678 data->pos_right_wrist[index] = new_pos_right_wrist;
1689 return data->pos_right_wrist_confidence;
1710 data->pos_right_wrist_confidence = new_pos_right_wrist_confidence;
1722 return data->pos_right_hand;
1736 throw Exception(
"Index value %u out of bounds (0..3)", index);
1738 return data->pos_right_hand[index];
1759 memcpy(data->pos_right_hand, new_pos_right_hand,
sizeof(
float) * 3);
1773 throw Exception(
"Index value %u out of bounds (0..3)", index);
1775 data->pos_right_hand[index] = new_pos_right_hand;
1786 return data->pos_right_hand_confidence;
1807 data->pos_right_hand_confidence = new_pos_right_hand_confidence;
1819 return data->pos_right_fingertip;
1833 throw Exception(
"Index value %u out of bounds (0..3)", index);
1835 return data->pos_right_fingertip[index];
1856 memcpy(data->pos_right_fingertip, new_pos_right_fingertip,
sizeof(
float) * 3);
1870 throw Exception(
"Index value %u out of bounds (0..3)", index);
1872 data->pos_right_fingertip[index] = new_pos_right_fingertip;
1883 return data->pos_right_fingertip_confidence;
1904 data->pos_right_fingertip_confidence = new_pos_right_fingertip_confidence;
1916 return data->pos_left_hip;
1930 throw Exception(
"Index value %u out of bounds (0..3)", index);
1932 return data->pos_left_hip[index];
1953 memcpy(data->pos_left_hip, new_pos_left_hip,
sizeof(
float) * 3);
1967 throw Exception(
"Index value %u out of bounds (0..3)", index);
1969 data->pos_left_hip[index] = new_pos_left_hip;
1980 return data->pos_left_hip_confidence;
2001 data->pos_left_hip_confidence = new_pos_left_hip_confidence;
2013 return data->pos_left_knee;
2027 throw Exception(
"Index value %u out of bounds (0..3)", index);
2029 return data->pos_left_knee[index];
2050 memcpy(data->pos_left_knee, new_pos_left_knee,
sizeof(
float) * 3);
2064 throw Exception(
"Index value %u out of bounds (0..3)", index);
2066 data->pos_left_knee[index] = new_pos_left_knee;
2077 return data->pos_left_knee_confidence;
2098 data->pos_left_knee_confidence = new_pos_left_knee_confidence;
2110 return data->pos_left_ankle;
2124 throw Exception(
"Index value %u out of bounds (0..3)", index);
2126 return data->pos_left_ankle[index];
2147 memcpy(data->pos_left_ankle, new_pos_left_ankle,
sizeof(
float) * 3);
2161 throw Exception(
"Index value %u out of bounds (0..3)", index);
2163 data->pos_left_ankle[index] = new_pos_left_ankle;
2174 return data->pos_left_ankle_confidence;
2195 data->pos_left_ankle_confidence = new_pos_left_ankle_confidence;
2207 return data->pos_left_foot;
2221 throw Exception(
"Index value %u out of bounds (0..3)", index);
2223 return data->pos_left_foot[index];
2244 memcpy(data->pos_left_foot, new_pos_left_foot,
sizeof(
float) * 3);
2258 throw Exception(
"Index value %u out of bounds (0..3)", index);
2260 data->pos_left_foot[index] = new_pos_left_foot;
2271 return data->pos_left_foot_confidence;
2292 data->pos_left_foot_confidence = new_pos_left_foot_confidence;
2304 return data->pos_right_hip;
2318 throw Exception(
"Index value %u out of bounds (0..3)", index);
2320 return data->pos_right_hip[index];
2341 memcpy(data->pos_right_hip, new_pos_right_hip,
sizeof(
float) * 3);
2355 throw Exception(
"Index value %u out of bounds (0..3)", index);
2357 data->pos_right_hip[index] = new_pos_right_hip;
2368 return data->pos_right_hip_confidence;
2389 data->pos_right_hip_confidence = new_pos_right_hip_confidence;
2401 return data->pos_right_knee;
2415 throw Exception(
"Index value %u out of bounds (0..3)", index);
2417 return data->pos_right_knee[index];
2438 memcpy(data->pos_right_knee, new_pos_right_knee,
sizeof(
float) * 3);
2452 throw Exception(
"Index value %u out of bounds (0..3)", index);
2454 data->pos_right_knee[index] = new_pos_right_knee;
2465 return data->pos_right_knee_confidence;
2486 data->pos_right_knee_confidence = new_pos_right_knee_confidence;
2498 return data->pos_right_ankle;
2512 throw Exception(
"Index value %u out of bounds (0..3)", index);
2514 return data->pos_right_ankle[index];
2535 memcpy(data->pos_right_ankle, new_pos_right_ankle,
sizeof(
float) * 3);
2549 throw Exception(
"Index value %u out of bounds (0..3)", index);
2551 data->pos_right_ankle[index] = new_pos_right_ankle;
2562 return data->pos_right_ankle_confidence;
2583 data->pos_right_ankle_confidence = new_pos_right_ankle_confidence;
2595 return data->pos_right_foot;
2609 throw Exception(
"Index value %u out of bounds (0..3)", index);
2611 return data->pos_right_foot[index];
2632 memcpy(data->pos_right_foot, new_pos_right_foot,
sizeof(
float) * 3);
2646 throw Exception(
"Index value %u out of bounds (0..3)", index);
2648 data->pos_right_foot[index] = new_pos_right_foot;
2659 return data->pos_right_foot_confidence;
2680 data->pos_right_foot_confidence = new_pos_right_foot_confidence;
2691 return data->ori_head;
2704 throw Exception(
"Index value %u out of bounds (0..9)", index);
2706 return data->ori_head[index];
2726 memcpy(data->ori_head, new_ori_head,
sizeof(
float) * 9);
2739 throw Exception(
"Index value %u out of bounds (0..9)", index);
2741 data->ori_head[index] = new_ori_head;
2752 return data->ori_head_confidence;
2773 data->ori_head_confidence = new_ori_head_confidence;
2784 return data->ori_neck;
2797 throw Exception(
"Index value %u out of bounds (0..9)", index);
2799 return data->ori_neck[index];
2819 memcpy(data->ori_neck, new_ori_neck,
sizeof(
float) * 9);
2832 throw Exception(
"Index value %u out of bounds (0..9)", index);
2834 data->ori_neck[index] = new_ori_neck;
2845 return data->ori_neck_confidence;
2866 data->ori_neck_confidence = new_ori_neck_confidence;
2877 return data->ori_torso;
2890 throw Exception(
"Index value %u out of bounds (0..9)", index);
2892 return data->ori_torso[index];
2912 memcpy(data->ori_torso, new_ori_torso,
sizeof(
float) * 9);
2925 throw Exception(
"Index value %u out of bounds (0..9)", index);
2927 data->ori_torso[index] = new_ori_torso;
2938 return data->ori_torso_confidence;
2959 data->ori_torso_confidence = new_ori_torso_confidence;
2970 return data->ori_waist;
2983 throw Exception(
"Index value %u out of bounds (0..9)", index);
2985 return data->ori_waist[index];
3005 memcpy(data->ori_waist, new_ori_waist,
sizeof(
float) * 9);
3018 throw Exception(
"Index value %u out of bounds (0..9)", index);
3020 data->ori_waist[index] = new_ori_waist;
3031 return data->ori_waist_confidence;
3052 data->ori_waist_confidence = new_ori_waist_confidence;
3064 return data->ori_left_collar;
3078 throw Exception(
"Index value %u out of bounds (0..9)", index);
3080 return data->ori_left_collar[index];
3101 memcpy(data->ori_left_collar, new_ori_left_collar,
sizeof(
float) * 9);
3115 throw Exception(
"Index value %u out of bounds (0..9)", index);
3117 data->ori_left_collar[index] = new_ori_left_collar;
3128 return data->ori_left_collar_confidence;
3149 data->ori_left_collar_confidence = new_ori_left_collar_confidence;
3161 return data->ori_left_shoulder;
3175 throw Exception(
"Index value %u out of bounds (0..9)", index);
3177 return data->ori_left_shoulder[index];
3198 memcpy(data->ori_left_shoulder, new_ori_left_shoulder,
sizeof(
float) * 9);
3212 throw Exception(
"Index value %u out of bounds (0..9)", index);
3214 data->ori_left_shoulder[index] = new_ori_left_shoulder;
3225 return data->ori_left_shoulder_confidence;
3246 data->ori_left_shoulder_confidence = new_ori_left_shoulder_confidence;
3258 return data->ori_left_elbow;
3272 throw Exception(
"Index value %u out of bounds (0..9)", index);
3274 return data->ori_left_elbow[index];
3295 memcpy(data->ori_left_elbow, new_ori_left_elbow,
sizeof(
float) * 9);
3309 throw Exception(
"Index value %u out of bounds (0..9)", index);
3311 data->ori_left_elbow[index] = new_ori_left_elbow;
3322 return data->ori_left_elbow_confidence;
3343 data->ori_left_elbow_confidence = new_ori_left_elbow_confidence;
3355 return data->ori_left_wrist;
3369 throw Exception(
"Index value %u out of bounds (0..9)", index);
3371 return data->ori_left_wrist[index];
3392 memcpy(data->ori_left_wrist, new_ori_left_wrist,
sizeof(
float) * 9);
3406 throw Exception(
"Index value %u out of bounds (0..9)", index);
3408 data->ori_left_wrist[index] = new_ori_left_wrist;
3419 return data->ori_left_wrist_confidence;
3440 data->ori_left_wrist_confidence = new_ori_left_wrist_confidence;
3452 return data->ori_left_hand;
3466 throw Exception(
"Index value %u out of bounds (0..9)", index);
3468 return data->ori_left_hand[index];
3489 memcpy(data->ori_left_hand, new_ori_left_hand,
sizeof(
float) * 9);
3503 throw Exception(
"Index value %u out of bounds (0..9)", index);
3505 data->ori_left_hand[index] = new_ori_left_hand;
3516 return data->ori_left_hand_confidence;
3537 data->ori_left_hand_confidence = new_ori_left_hand_confidence;
3549 return data->ori_left_fingertip;
3563 throw Exception(
"Index value %u out of bounds (0..9)", index);
3565 return data->ori_left_fingertip[index];
3586 memcpy(data->ori_left_fingertip, new_ori_left_fingertip,
sizeof(
float) * 9);
3600 throw Exception(
"Index value %u out of bounds (0..9)", index);
3602 data->ori_left_fingertip[index] = new_ori_left_fingertip;
3613 return data->ori_left_fingertip_confidence;
3634 data->ori_left_fingertip_confidence = new_ori_left_fingertip_confidence;
3646 return data->ori_right_collar;
3660 throw Exception(
"Index value %u out of bounds (0..9)", index);
3662 return data->ori_right_collar[index];
3683 memcpy(data->ori_right_collar, new_ori_right_collar,
sizeof(
float) * 9);
3697 throw Exception(
"Index value %u out of bounds (0..9)", index);
3699 data->ori_right_collar[index] = new_ori_right_collar;
3710 return data->ori_right_collar_confidence;
3731 data->ori_right_collar_confidence = new_ori_right_collar_confidence;
3743 return data->ori_right_shoulder;
3757 throw Exception(
"Index value %u out of bounds (0..9)", index);
3759 return data->ori_right_shoulder[index];
3780 memcpy(data->ori_right_shoulder, new_ori_right_shoulder,
sizeof(
float) * 9);
3794 throw Exception(
"Index value %u out of bounds (0..9)", index);
3796 data->ori_right_shoulder[index] = new_ori_right_shoulder;
3807 return data->ori_right_shoulder_confidence;
3828 data->ori_right_shoulder_confidence = new_ori_right_shoulder_confidence;
3840 return data->ori_right_elbow;
3854 throw Exception(
"Index value %u out of bounds (0..9)", index);
3856 return data->ori_right_elbow[index];
3877 memcpy(data->ori_right_elbow, new_ori_right_elbow,
sizeof(
float) * 9);
3891 throw Exception(
"Index value %u out of bounds (0..9)", index);
3893 data->ori_right_elbow[index] = new_ori_right_elbow;
3904 return data->ori_right_elbow_confidence;
3925 data->ori_right_elbow_confidence = new_ori_right_elbow_confidence;
3937 return data->ori_right_wrist;
3951 throw Exception(
"Index value %u out of bounds (0..9)", index);
3953 return data->ori_right_wrist[index];
3974 memcpy(data->ori_right_wrist, new_ori_right_wrist,
sizeof(
float) * 9);
3988 throw Exception(
"Index value %u out of bounds (0..9)", index);
3990 data->ori_right_wrist[index] = new_ori_right_wrist;
4001 return data->ori_right_wrist_confidence;
4022 data->ori_right_wrist_confidence = new_ori_right_wrist_confidence;
4034 return data->ori_right_hand;
4048 throw Exception(
"Index value %u out of bounds (0..9)", index);
4050 return data->ori_right_hand[index];
4071 memcpy(data->ori_right_hand, new_ori_right_hand,
sizeof(
float) * 9);
4085 throw Exception(
"Index value %u out of bounds (0..9)", index);
4087 data->ori_right_hand[index] = new_ori_right_hand;
4098 return data->ori_right_hand_confidence;
4119 data->ori_right_hand_confidence = new_ori_right_hand_confidence;
4131 return data->ori_right_fingertip;
4145 throw Exception(
"Index value %u out of bounds (0..9)", index);
4147 return data->ori_right_fingertip[index];
4168 memcpy(data->ori_right_fingertip, new_ori_right_fingertip,
sizeof(
float) * 9);
4182 throw Exception(
"Index value %u out of bounds (0..9)", index);
4184 data->ori_right_fingertip[index] = new_ori_right_fingertip;
4195 return data->ori_right_fingertip_confidence;
4216 data->ori_right_fingertip_confidence = new_ori_right_fingertip_confidence;
4228 return data->ori_left_hip;
4242 throw Exception(
"Index value %u out of bounds (0..9)", index);
4244 return data->ori_left_hip[index];
4265 memcpy(data->ori_left_hip, new_ori_left_hip,
sizeof(
float) * 9);
4279 throw Exception(
"Index value %u out of bounds (0..9)", index);
4281 data->ori_left_hip[index] = new_ori_left_hip;
4292 return data->ori_left_hip_confidence;
4313 data->ori_left_hip_confidence = new_ori_left_hip_confidence;
4325 return data->ori_left_knee;
4339 throw Exception(
"Index value %u out of bounds (0..9)", index);
4341 return data->ori_left_knee[index];
4362 memcpy(data->ori_left_knee, new_ori_left_knee,
sizeof(
float) * 9);
4376 throw Exception(
"Index value %u out of bounds (0..9)", index);
4378 data->ori_left_knee[index] = new_ori_left_knee;
4389 return data->ori_left_knee_confidence;
4410 data->ori_left_knee_confidence = new_ori_left_knee_confidence;
4422 return data->ori_left_ankle;
4436 throw Exception(
"Index value %u out of bounds (0..9)", index);
4438 return data->ori_left_ankle[index];
4459 memcpy(data->ori_left_ankle, new_ori_left_ankle,
sizeof(
float) * 9);
4473 throw Exception(
"Index value %u out of bounds (0..9)", index);
4475 data->ori_left_ankle[index] = new_ori_left_ankle;
4486 return data->ori_left_ankle_confidence;
4507 data->ori_left_ankle_confidence = new_ori_left_ankle_confidence;
4519 return data->ori_left_foot;
4533 throw Exception(
"Index value %u out of bounds (0..9)", index);
4535 return data->ori_left_foot[index];
4556 memcpy(data->ori_left_foot, new_ori_left_foot,
sizeof(
float) * 9);
4570 throw Exception(
"Index value %u out of bounds (0..9)", index);
4572 data->ori_left_foot[index] = new_ori_left_foot;
4583 return data->ori_left_foot_confidence;
4604 data->ori_left_foot_confidence = new_ori_left_foot_confidence;
4616 return data->ori_right_hip;
4630 throw Exception(
"Index value %u out of bounds (0..9)", index);
4632 return data->ori_right_hip[index];
4653 memcpy(data->ori_right_hip, new_ori_right_hip,
sizeof(
float) * 9);
4667 throw Exception(
"Index value %u out of bounds (0..9)", index);
4669 data->ori_right_hip[index] = new_ori_right_hip;
4680 return data->ori_right_hip_confidence;
4701 data->ori_right_hip_confidence = new_ori_right_hip_confidence;
4713 return data->ori_right_knee;
4727 throw Exception(
"Index value %u out of bounds (0..9)", index);
4729 return data->ori_right_knee[index];
4750 memcpy(data->ori_right_knee, new_ori_right_knee,
sizeof(
float) * 9);
4764 throw Exception(
"Index value %u out of bounds (0..9)", index);
4766 data->ori_right_knee[index] = new_ori_right_knee;
4777 return data->ori_right_knee_confidence;
4798 data->ori_right_knee_confidence = new_ori_right_knee_confidence;
4810 return data->ori_right_ankle;
4824 throw Exception(
"Index value %u out of bounds (0..9)", index);
4826 return data->ori_right_ankle[index];
4847 memcpy(data->ori_right_ankle, new_ori_right_ankle,
sizeof(
float) * 9);
4861 throw Exception(
"Index value %u out of bounds (0..9)", index);
4863 data->ori_right_ankle[index] = new_ori_right_ankle;
4874 return data->ori_right_ankle_confidence;
4895 data->ori_right_ankle_confidence = new_ori_right_ankle_confidence;
4907 return data->ori_right_foot;
4921 throw Exception(
"Index value %u out of bounds (0..9)", index);
4923 return data->ori_right_foot[index];
4944 memcpy(data->ori_right_foot, new_ori_right_foot,
sizeof(
float) * 9);
4958 throw Exception(
"Index value %u out of bounds (0..9)", index);
4960 data->ori_right_foot[index] = new_ori_right_foot;
4971 return data->ori_right_foot_confidence;
4992 data->ori_right_foot_confidence = new_ori_right_foot_confidence;
5001 "message type for this interface type.", type);
5016 memcpy(data, oi->data,
sizeof(HumanSkeletonInterface_data_t));
5022 if (strcmp(enumtype,
"State") == 0) {
5023 return tostring_State((
State)val);