modified accel function to get it working
modified accel to take into account FS range and return values for XYZT