worked on fir/iir filters

sensors/imu/PoseDetectionPlot.h

@@ -111,6 +111,19 @@
 					}
 				}
 
+//				// update un-rotated 3D smartphone model
+//				for (size_t i = 0; i < pose.size(); ++i) {
+//					K::GnuplotObjectPolygon* gp = (K::GnuplotObjectPolygon*) plotPose.getObjects().get(i+1); gp->clear();
+//					for (const std::vector<float>& pts : pose[i]) {
+//						const Vector3 vec1(pts[0], pts[1], pts[2]);
+//						const Vector3 vec2 = vec1 - Vector3(0.5, 0.5, 0.5);			// center cube at 0,0,0
+//						const Vector3 vec3 = vec2 * Vector3(7, 15, 1);				// stretch cube
+//						const Vector3 vec4 = rotation * vec3;
+
+//						gp->add(K::GnuplotCoordinate3(vec4.x, vec4.y, vec4.z, K::GnuplotCoordinateSystem::FIRST));
+//					}
+//				}
+
 				// add coordinate system
 				const Vector3 vx = rotation * Vector3(2,0,0);
 				const Vector3 vy = rotation * Vector3(0,3,0);