D_sub from DEM: Implement faster LM solver by seeking over ray