forward

Dependencies:   VNH5019

Fork of AigamozuControlPackets by aigamozu

Revision:
36:52d6b1759f5b
Parent:
22:4f1516421f02
diff -r 4f1516421f02 -r 52d6b1759f5b AigamozuControlPackets.cpp
--- a/AigamozuControlPackets.cpp	Wed May 13 08:41:19 2015 +0000
+++ b/AigamozuControlPackets.cpp	Sun May 24 08:07:52 2015 +0000
@@ -72,18 +72,19 @@
 // set関数
 //////////////////////////////
 void AigamozuControlPackets::set_agzCov(double cov_lati,double cov_longi){
-    agzCov.x = cov_lati / 10000.0/60.0;
-    agzCov.y = cov_longi / 10000.0/60.0;    
+    agzCov.x = cov_lati;
+    agzCov.y = cov_longi;    
 }
 
-void AigamozuControlPackets::set_agzAutoGPS(){
-    agzPoint.x += 0.00001;
-    //agzPoint.y += 0.001;
+void AigamozuControlPackets::set_agzPointKalman_lati(double kalman_lati){
+
+    agzPointKalman.x = kalman_lati;   
+     
 }
-
-void AigamozuControlPackets::set_agzKalmanGPS(){
-    agzPointKalman.x += 0.00001;
-    //agzPointKalman.y += 0.001;
+        
+void AigamozuControlPackets::set_agzPointKalman_longi(double kalman_longi){
+    
+    agzPointKalman.y = kalman_longi;
     
 }
 //////////////////////////////