Initial version of GPS-IMU PIC code.
First working version