Kalman Filter Localization Algorithm Based on SDSTWR Ranging