請求關於GPS的幫助

t0931094462

小弟是專題生，是在做舊版MK四旋翼。
因為MK導航系統不開源。因為導航系統不能更動，不能送出到定位點訊息。
所以我們希望使用arduino結合GPS，用一伺服機推動桿子使MINI DV拍照(analogRead DELAY analogRead DELAY 約4行)。

不過小弟沒接觸過arduino，希望大家能多照顧幫忙小弟我。

小弟現在手邊有TINY GPS的程式 以及一個簡單的 伺服機選轉至某一角度的程式

我想實現:當GPS位置經度變動量小於5公尺時 轉動伺服機使DV拍照
但是小弟不知如何寫出程式

預想判斷式的內容大概是
取得當前經度位置 儲存 (暫且稱為 i )←----------------------------------
延遲0.5秒                                                                                      |
判斷當前精度位置 儲存(暫且稱為 j )                                              |
i-j                                                                                                   |
IF  i-j 的絕對值小於0.00005(GPS小數點第5位約為一公尺)             |
伺服機旋轉使DV拍照                                                                     |
如果大於0.00005 則程式回到→-------------------------------------------
經度位置從 TINY GPS取出

結合 TINY GPS, GPS判斷式,以及伺服機選轉程式  
以上是我的問題

請各位前輩不吝嗇的給予指教
謝謝!