test

Dependencies:   VNH5019

Fork of AigamozuControlPackets by Haruna Nakazawa

Revision:
2:30e4ea7de224
Parent:
1:6d7c854c927d
Child:
3:6c7084121bd6
--- a/AigamozuControlPackets.cpp	Tue May 12 10:50:56 2015 +0000
+++ b/AigamozuControlPackets.cpp	Tue May 12 12:02:07 2015 +0000
@@ -12,21 +12,29 @@
     //basePoint[0].y = 3731.5060;
     basePoint[0].x = 37.524505;
     basePoint[0].y = 139.939510;
+    basePointKalman[0].x = 37.524505;
+    basePointKalman[0].y = 139.939510;
     
     //basePoint[1].x = 13956.2898;
     //basePoint[1].y = 3731.5055;
     basePoint[1].x = 37.524747;
     basePoint[1].y = 139.939510;
+    basePointKalman[1].x = 37.524747;
+    basePointKalman[1].y = 139.939510;
     
     //basePoint[2].x = 13956.2915;
     //basePoint[2].y = 3731.5245;
     basePoint[2].x = 37.524747;
     basePoint[2].y = 139.939530;
-    
+    basePointKalman[2].x = 37.524747;
+    basePointKalman[2].y = 139.939530;  
+      
     //basePoint[3].x = 13956.2680;
     //basePoint[3].y = 3731.5248;
     basePoint[3].x = 37.524505;
     basePoint[3].y = 139.939530;
+    basePointKalman[3].x = 37.524505;
+    basePointKalman[3].y = 139.939530;
     
     agzPoint.x=37.524600;agzPoint.y=139.939520;
     agzPointKalman.x=37.524600;agzPointKalman.y=139.939520;