%% Translation stage
figure
plot(ty)
title('Moving y')
xlabel('time (s)')
ylabel('distance (m)')