Added functionality to only read data from 1:the time contained by the last entry in the State vector. We do safety checking to ensure that this number is never less than the last time item in Angles.dat or CartPos.dat or Torques.dat