fixing (long) on pidVel.interpolate, and several index issues in pidGetDetpoint