Adding Code: inertial_compensation, time_delay

Adding Inertial Compensation Function, Compensation Test, and Time Delay
function