Revision b68e468e
| src/server/mouth_motion_generator.cpp | ||
|---|---|---|
| 78 | 78 |
float distance_min_upper = unsafe_target_upper - min_upper; |
| 79 | 79 |
if (distance_min_upper < 0){
|
| 80 | 80 |
//oops, we will get to close to the safe border, abort move! |
| 81 |
printf("> collision on TOP [u=%4.2f l=%4.2f]\n",unsafe_target_upper, unsafe_target_lower);
|
|
| 81 |
//printf("> collision on TOP [u=%4.2f l=%4.2f]\n",unsafe_target_upper, unsafe_target_lower);
|
|
| 82 | 82 |
unsafe_target_upper = min_upper; |
| 83 | 83 |
unsafe_target_lower = unsafe_target_upper + opening; |
| 84 | 84 |
} |
| ... | ... | |
| 86 | 86 |
float distance_max_lower = max_lower - unsafe_target_lower; |
| 87 | 87 |
if (distance_max_lower < 0){
|
| 88 | 88 |
//oops, we will get to close to the safe border, abort move! |
| 89 |
printf("> collision on BOT[u=%4.2f l=%4.2f]\n",unsafe_target_upper, unsafe_target_lower);
|
|
| 89 |
//printf("> collision on BOT[u=%4.2f l=%4.2f]\n",unsafe_target_upper, unsafe_target_lower);
|
|
| 90 | 90 |
unsafe_target_lower = max_lower; |
| 91 | 91 |
unsafe_target_upper = unsafe_target_lower - opening; |
| 92 | 92 |
} |
Also available in: Unified diff