Revision c0b29ddc
| src/server/controller.cpp | ||
|---|---|---|
| 110 | 110 |
//in case we did not see this timestamp before, show a warning: |
| 111 | 111 |
if (last_known_absolute_timestamp != relative_target_timestamp){
|
| 112 | 112 |
printf("> WARNING: restored/guessed absolute target for unknown timestamp %f [this should not happen]\n", relative_target_timestamp.to_seconds());
|
| 113 |
last_known_absolute_target_pan = 0.0; |
|
| 114 |
last_known_absolute_target_tilt = 0.0; |
|
| 115 |
last_known_absolute_target_roll = 0.0; |
|
| 113 | 116 |
} |
| 114 | 117 |
}else{
|
| 115 | 118 |
//all fine, we can reconstruct the absolute target: |
| ... | ... | |
| 143 | 146 |
absolute_gaze.pan = pan + relative.pan; |
| 144 | 147 |
absolute_gaze.tilt = tilt + relative.tilt; |
| 145 | 148 |
absolute_gaze.roll = roll + relative.roll; |
| 146 |
//printf("pan now = %4.1f, rel=%4.1f ===> %4.2f\n",pan,relative.pan,absolute_gaze.pan);
|
|
| 147 |
//printf("tilt now = %4.1f, rel=%4.1f ===> %4.2f\n",tilt,relative.tilt,absolute_gaze.tilt);
|
|
| 149 |
printf("pan now = %4.1f, rel=%4.1f ===> %4.2f\n",pan,relative.pan,absolute_gaze.pan);
|
|
| 150 |
printf("tilt now = %4.1f, rel=%4.1f ===> %4.2f\n",tilt,relative.tilt,absolute_gaze.tilt);
|
|
| 148 | 151 |
|
| 149 | 152 |
//FIXME: use ros TF for that calculation... |
| 150 | 153 |
//see http://wiki.ros.org/tf/Tutorials/Time%20travel%20with%20tf%20%28C%2B%2B%29 |
Also available in: Unified diff