Changed some stuff but still no worky

Forgot to update velocity in interpolate function. Of course this hasn't
changed anything. The major problem seems to be xv going runaway even
though no input is given (or rather, xv is set to 0 yet it runs away).