Fix wrong cloud offset

For filtering points with sensor_range, distance between sensor_origin and a point was used for limiting range.
But, the point was not converted to the fixed frame, it still being on the sensor frame.
So, distance should be calculated at the sensor frame.