_head_belly_vy = _head_belly_vy/l * _head_radius * 2;
_head_belly_edge_shift = int(floor(- RichImage::nb_edge_tags * atan2(_head_belly_ux, _head_belly_uy) / (2 * M_PI) + 0.5));
_head_belly_edge_shift = (RichImage::nb_edge_tags + _head_belly_edge_shift) % RichImage::nb_edge_tags;
-
- // Body frame
-
-// _body_ux = cos(_body_tilt) * _body_radius_1 * 2.0;
-// _body_uy = sin(_body_tilt) * _body_radius_1 * 2.0;
-// _body_vx = - sin(_body_tilt) * _body_radius_2 * 2.0;
-// _body_vy = cos(_body_tilt) * _body_radius_2 * 2.0;
-
}
int PiReferential::common_scale() {