Vision: Re-integrate particle filter positions