Vectorized matlab code and changed to ode23 for time stamp solving.
Maybe implement optional ode45 ?