RK4 conversion

RK4 converted to vec3 usage, seems to work for 3D.