Revision f311c844
| cfg/humotion.cfg | ||
|---|---|---|
| 6 | 6 |
def fetch_default(param_name): |
| 7 | 7 |
for line in open("../src/server/config.cpp"):
|
| 8 | 8 |
if param_name in line: |
| 9 |
result = re.findall("=\s*([\d.]+);", line)
|
|
| 9 |
result = re.findall("=\s*([\d\w.]+);", line)
|
|
| 10 | 10 |
print result |
| 11 | 11 |
if result: |
| 12 | 12 |
return result[0] |
| examples/yarp_icub/src/icub_jointinterface.cpp | ||
|---|---|---|
| 108 | 108 |
insert_icupid_to_humotionid_mapping(ICUB_ID_NECK_PAN, ID_NECK_PAN); |
| 109 | 109 |
insert_icupid_to_humotionid_mapping(ICUB_ID_NECK_TILT, ID_NECK_TILT); |
| 110 | 110 |
insert_icupid_to_humotionid_mapping(ICUB_ID_NECK_ROLL, ID_NECK_ROLL); |
| 111 |
// FIXME: remove this hack tha repurposes LEFT/RIGHT eye pan from humotion as vergence/pan
|
|
| 111 |
// |
|
| 112 | 112 |
insert_icupid_to_humotionid_mapping(ICUB_ID_EYES_PAN, ID_EYES_LEFT_LR); |
| 113 | 113 |
insert_icupid_to_humotionid_mapping(ICUB_ID_EYES_VERGENCE, ID_EYES_RIGHT_LR); |
| 114 | 114 |
insert_icupid_to_humotionid_mapping(ICUB_ID_EYES_BOTH_UD, ID_EYES_BOTH_UD); |
| src/server/eyelid_motion_generator.cpp | ||
|---|---|---|
| 60 | 60 |
// fetch current angles |
| 61 | 61 |
float eye_tilt_now = get_current_position(JointInterface::ID_EYES_BOTH_UD); |
| 62 | 62 |
|
| 63 |
float eyelid_target = 0.0; |
|
| 64 |
if (config->eyelids_follow_eyemotion) {
|
|
| 65 |
// the eyelids shoudl follow the eye motion |
|
| 66 |
// therefore copy the eyeballs tilt position |
|
| 67 |
eyelid_target = eye_tilt_now; |
|
| 68 |
} |
|
| 69 |
|
|
| 63 | 70 |
// calculate left eyelid targets |
| 64 |
float eyelid_upper_left_target = eye_tilt_now + requested_gaze_state_.eyelid_opening_upper;
|
|
| 65 |
float eyelid_lower_left_target = eye_tilt_now - requested_gaze_state_.eyelid_opening_lower;
|
|
| 71 |
float eyelid_upper_left_target = eyelid_target + requested_gaze_state_.eyelid_opening_upper;
|
|
| 72 |
float eyelid_lower_left_target = eyelid_target - requested_gaze_state_.eyelid_opening_lower;
|
|
| 66 | 73 |
|
| 67 | 74 |
// calculate right eyelid targets |
| 68 |
float eyelid_upper_right_target = eye_tilt_now + requested_gaze_state_.eyelid_opening_upper;
|
|
| 69 |
float eyelid_lower_right_target = eye_tilt_now - requested_gaze_state_.eyelid_opening_lower;
|
|
| 75 |
float eyelid_upper_right_target = eyelid_target + requested_gaze_state_.eyelid_opening_upper;
|
|
| 76 |
float eyelid_lower_right_target = eyelid_target - requested_gaze_state_.eyelid_opening_lower;
|
|
| 70 | 77 |
|
| 71 | 78 |
// limit target angles |
| 72 | 79 |
eyelid_upper_left_target = limit_target(JointInterface::ID_EYES_LEFT_LID_UPPER, |
| src/server/middleware_ros.cpp | ||
|---|---|---|
| 101 | 101 |
config->breath_period = dyn_config.breath_period; |
| 102 | 102 |
config->breath_amplitude = dyn_config.breath_amplitude; |
| 103 | 103 |
|
| 104 |
// parameters for eyelids |
|
| 105 |
config->eyelids_follow_eyemotion = dyn_config.eyelids_follow_eyemotion; |
|
| 106 |
|
|
| 104 | 107 |
// parameters for eye blinking |
| 105 | 108 |
config->eyeblink_duration = dyn_config.eyeblink_duration; |
| 106 | 109 |
config->eyeblink_periodic_distribution_lower = dyn_config.eyeblink_periodic_distribution_lower; |
Also available in: Unified diff