Add integrate function to src/wheel_soil.cpp