Diff: agz_common.cpp

Revision:

3:14e469b0c33e

Parent:

0:54e62ef6d287

--- a/agz_common.cpp	Wed Jun 18 13:48:18 2014 +0000
+++ b/agz_common.cpp	Mon Apr 20 10:36:59 2015 +0000
@@ -54,9 +54,6 @@
 }
 
 
-
-
-
 //get function
 long AGZ_ROBOT::get_LatitudeH(){
     return LatitudeH.value_long;
@@ -75,4 +72,43 @@
 }
 uint8_t AGZ_ROBOT::get_state(){
     return state;
-}
\ No newline at end of file
+}
+
+
+void AGZ_ROBOT::set_LatitudeKH(uint8_t *data){
+    for(int i = 0;i < 3;i++)
+        LatitudeKH.value_ch[i] = data[i];
+}
+
+void AGZ_ROBOT::set_LatitudeKL(uint8_t *data){
+    for(int i = 0;i < 6;i++)
+        LatitudeKL.value_ch[i] = data[i];
+}
+
+void AGZ_ROBOT::set_LongitudeKH(uint8_t *data){
+    for(int i = 0;i < 3;i++)
+        LongitudeKH.value_ch[i] = data[i];
+}
+
+void AGZ_ROBOT::set_LongitudeKL(uint8_t *data){
+    for(int i = 0;i < 6;i++)
+        LongitudeKL.value_ch[i] = data[i];
+}
+
+
+//get function
+long AGZ_ROBOT::get_LatitudeKH(){
+    return LatitudeKH.value_long;
+}
+
+long AGZ_ROBOT::get_LatitudeKL(){
+    return LatitudeKL.value_long;
+}
+
+long AGZ_ROBOT::get_LongitudeKH(){
+    return LongitudeKH.value_long;
+}
+
+long AGZ_ROBOT::get_LongitudeKL(){
+    return LongitudeKL.value_long;
+}