A method of operating a light detection and ranging (LiDAR) system is provided that includes performing a scene measurement using a LiDAR sensor capable of measuring Doppler per point. The method also includes estimating a velocity of the LiDAR sensor with respect to static points within the scene based on the scene measurement. The method may also include compensating for the velocity of the LiDAR sensor and compensating for a Doppler velocity of the LiDAR sensor.