Simulate one ATRIAS leg in MATLAB