|
|
|
@ -47,7 +47,7 @@ int BlockLocalPositionEstimator::visionMeasure(Vector<float, n_y_vision> &y)
@@ -47,7 +47,7 @@ int BlockLocalPositionEstimator::visionMeasure(Vector<float, n_y_vision> &y)
|
|
|
|
|
y(Y_vision_y) = _sub_vision_pos.get().y; |
|
|
|
|
y(Y_vision_z) = _sub_vision_pos.get().z; |
|
|
|
|
_visionStats.update(y); |
|
|
|
|
_time_last_vision_p = _sub_vision_pos.get().timestamp_boot; |
|
|
|
|
_time_last_vision_p = _sub_vision_pos.get().timestamp; |
|
|
|
|
return OK; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|