Fixed the timestep problem where dt_half was not set.
Changed more arrays to std vectors.