Tested

Test code, works well.
move gps to serail1
time interval fix.