Basic RK4 working, plotting animation in Matlab