Lines Matching refs:cvPoint3D32f
59 static void FillObjectPoints(CvPoint3D32f *obj_points, CvSize etalon_size, float square_size);
64 static CvPoint3D32f ImageCStoWorldCS(const Cv3dTrackerCameraInfo &camera_info, CvPoint2D32f p);
65 static bool intersection(CvPoint3D32f o1, CvPoint3D32f p1,
66 CvPoint3D32f o2, CvPoint3D32f p2,
67 CvPoint3D32f &r1, CvPoint3D32f &r2);
82 CvPoint3D32f *object_points = NULL; // real-world coordinates of checkerboard points
127 CV_CALL(object_points = (CvPoint3D32f *)cvAlloc(num_points * sizeof(CvPoint3D32f)));
309 static void FillObjectPoints(CvPoint3D32f *obj_points, CvSize etalon_size, float square_size)
378 static CvPoint3D32f midpoint(const CvPoint3D32f &p1, const CvPoint3D32f &p2)
380 return cvPoint3D32f((p1.x+p2.x)/2, (p1.y+p2.y)/2, (p1.z+p2.z)/2);
383 static void operator +=(CvPoint3D32f &p1, const CvPoint3D32f &p2)
390 static CvPoint3D32f operator /(const CvPoint3D32f &p, int d)
392 return cvPoint3D32f(p.x/d, p.y/d, p.z/d);
405 #define CAMERA_POS(c) (cvPoint3D32f((c).mat[3][0], (c).mat[3][1], (c).mat[3][2]))
442 CvPoint3D32f total = cvPoint3D32f(0, 0, 0);
455 CvPoint3D32f p1a = CAMERA_POS(camera_info[c1]);
456 CvPoint3D32f p1b = ImageCStoWorldCS(camera_info[c1], o1->p);
468 CvPoint3D32f p2a = CAMERA_POS(camera_info[c2]);
469 CvPoint3D32f p2b = ImageCStoWorldCS(camera_info[c2], o2->p);
473 CvPoint3D32f r1 = cvPoint3D32f(0, 0, 0);
474 CvPoint3D32f r2 = cvPoint3D32f(0, 0, 0);
486 CvPoint3D32f center = total/weight;
496 static inline double det(CvPoint3D32f v1, CvPoint3D32f v2, CvPoint3D32f v3)
502 static CvPoint3D32f operator +(CvPoint3D32f a, CvPoint3D32f b)
504 return cvPoint3D32f(a.x + b.x, a.y + b.y, a.z + b.z);
507 static CvPoint3D32f operator -(CvPoint3D32f a, CvPoint3D32f b)
509 return cvPoint3D32f(a.x - b.x, a.y - b.y, a.z - b.z);
512 static CvPoint3D32f operator *(CvPoint3D32f v, double f)
514 return cvPoint3D32f(f*v.x, f*v.y, f*v.z);
523 static bool intersection(CvPoint3D32f o1, CvPoint3D32f p1,
524 CvPoint3D32f o2, CvPoint3D32f p2,
525 CvPoint3D32f &r1, CvPoint3D32f &r2)
527 CvPoint3D32f x = o2 - o1;
528 CvPoint3D32f d1 = p1 - o1;
529 CvPoint3D32f d2 = p2 - o2;
531 CvPoint3D32f cross = cvPoint3D32f(d1.y*d2.z - d1.z*d2.y,
550 static CvPoint3D32f ImageCStoWorldCS(const Cv3dTrackerCameraInfo &camera_info, CvPoint2D32f p)
562 return cvPoint3D32f(tr[0]/tr[3], tr[1]/tr[3], tr[2]/tr[3]);
