FPS working, removed major delays. Updated FPS lib to change interval delay as return packet would close before serial connection would return value from FPS.