开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 多媒体 > 流媒体/Mpeg4/MP4 > 查看源码
warp.cpp
资源名称：NETVIDEO.rar　[点击查看]
上传用户：sun1608
上传日期：2007-02-02
资源大小：6116k
文件大小：12k
源码类别：

流媒体/Mpeg4/MP4

开发平台：

Visual C++

warp.cpp：源码内容
  1. /*************************************************************************
  3. This software module was originally developed by 
  5. Ming-Chieh Lee (mingcl@microsoft.com), Microsoft Corporation
  6. Wei-ge Chen (wchen@microsoft.com), Microsoft Corporation
  7. Bruce Lin (blin@microsoft.com), Microsoft Corporation
  8. Chuang Gu (chuanggu@microsoft.com), Microsoft Corporation
  9. (date: March, 1996)
  11. and also edited by
  13.     Yuichiro Nakaya (Hitachi, Ltd.)
  14.     Yoshinori Suzuki (Hitachi, Ltd.)
  16. in the course of development of the MPEG-4 Video (ISO/IEC 14496-2). 
  17. This software module is an implementation of a part of one or more MPEG-4 Video tools 
  18. as specified by the MPEG-4 Video. 
  19. ISO/IEC gives users of the MPEG-4 Video free license to this software module or modifications 
  20. thereof for use in hardware or software products claiming conformance to the MPEG-4 Video. 
  21. Those intending to use this software module in hardware or software products are advised that its use may infringe existing patents. 
  22. The original developer of this software module and his/her company, 
  23. the subsequent editors and their companies, 
  24. and ISO/IEC have no liability for use of this software module or modifications thereof in an implementation. 
  25. Copyright is not released for non MPEG-4 Video conforming products. 
  26. Microsoft retains full right to use the code for his/her own purpose, 
  27. assign or donate the code to a third party and to inhibit third parties from using the code for non <MPEG standard> conforming products. 
  28. This copyright notice must be included in all copies or derivative works. 
  30. Copyright (c) 1996, 1997.
  32. Module Name:
  34. warp.cpp
  36. Abstract:
  38. Geometry transformation:
  39. 2D Affine
  40. 2D Perspective
  42. Revision History:
  43. Jan. 13, 1999: Code for disallowing zero demoninators in perspective
  44.                        warping added by Hitachi, Ltd.
  46. *************************************************************************/
  48. #include <math.h>
  49. #include "basic.hpp"
  50. #include "svd.h"
  51. #include "warp.hpp"
  53. #ifdef __MFC_
  54. #ifdef _DEBUG
  55. #undef THIS_FILE
  56. static char BASED_CODE THIS_FILE[] = __FILE__;
  57. #endif
  59. #define new DEBUG_NEW    
  60. #endif // __MFC_
  63. CVector2D CMatrix2x2D::apply (const CVector2D& v) const
  64. {
  65.   return CVector2D (
  66. m_value [0] [0] * v.x + m_value [0] [1] * v.y, 
  67. m_value [1] [0] * v.x + m_value [1] [1] * v.y 
  68. ); 
  69. }
  72. CMatrix2x2D::CMatrix2x2D (Double d)
  73. {
  74. m_value [0] [0] = d; 
  75. m_value [1] [1] = d; 
  76. m_value [0] [1] = 0; 
  77. m_value [1] [0] = 0; 
  78. }
  80. CMatrix2x2D::CMatrix2x2D (Double d00, Double d01, Double d10, Double d11)
  81. {
  82. m_value [0] [0] = d00; 
  83. m_value [1] [1] = d11; 
  84. m_value [0] [1] = d01; 
  85. m_value [1] [0] = d10; 
  86. }
  88. CMatrix2x2D::CMatrix2x2D (const CVector2D& v0, const CVector2D& v1, Bool fAsColumns)
  89. {
  90. m_value [0] [0] = v0.x; 
  91. m_value [1] [0] = v0.y; 
  92. m_value [0] [1] = v1.x; 
  93. m_value [1] [1] = v1.y; 
  95. if (!fAsColumns) transpose (); 
  96. }
  98. CMatrix2x2D::CMatrix2x2D (const CVector2D v [2])
  99. {
  100. *this = CMatrix2x2D (v [0], v [1]); 
  101. }
  104. CMatrix2x2D CMatrix2x2D::operator * (const CMatrix2x2D& x) const 
  105. {
  106. CMatrix2x2D r; 
  107. r.m_value [0] [0] = m_value [0] [0] * x.m_value [0] [0] + m_value [0] [1] * x.m_value [1] [0]; 
  108. r.m_value [1] [0] = m_value [1] [0] * x.m_value [0] [0] + m_value [1] [1] * x.m_value [1] [0]; 
  109. r.m_value [0] [1] = m_value [0] [0] * x.m_value [0] [1] + m_value [0] [1] * x.m_value [1] [1]; 
  110. r.m_value [1] [1] = m_value [1] [0] * x.m_value [0] [1] + m_value [1] [1] * x.m_value [1] [1]; 
  111. return r; 
  112. }
  114. CMatrix2x2D::CMatrix2x2D (const CVector2D& s0, const CVector2D& s1, const CVector2D& d0, const CVector2D& d1) 
  115. {
  116. *this = CMatrix2x2D (d0, d1) * CMatrix2x2D (s0, s1).inverse (); 
  117. }
  119. CMatrix2x2D::CMatrix2x2D (const CVector2D source [2], const CVector2D dest [2])
  120. {
  121. *this = CMatrix2x2D (source [0], source [1], dest [0], dest [1]); 
  122. }
  124. CMatrix2x2D CMatrix2x2D::inverse () const
  125. {
  126. Double det = determinant (); 
  127. if (det == 0) // ill conditioned -- make this a better test
  128. {
  129. return CMatrix2x2D ((Double) 0); 
  130. }
  132. CMatrix2x2D r; 
  133. Double detInv = (Double) 1.0 / det; 
  134. r.m_value [0] [0] = m_value [1] [1] * detInv; 
  135. r.m_value [1] [1] = m_value [0] [0] * detInv; 
  136. r.m_value [0] [1] = - m_value [0] [1] * detInv; 
  137. r.m_value [1] [0] = - m_value [1] [0] * detInv; 
  138. return r; 
  139. }
  141. Void CMatrix2x2D::transpose ()
  142. {
  143. Double tmp = m_value [0] [1]; 
  144. m_value [0] [1] = m_value [1] [0]; 
  145. m_value [1] [0] = tmp; 
  146. }
  149. CAffine2D::CAffine2D (const CSiteD& source, const CSiteD& dest) : 
  150. m_mtx(1.), m_stdSrc (source), m_stdDst (dest)
  151. {
  152. // thats all folks
  153. }
  156. CAffine2D::CAffine2D (const CSiteD& s0, const CSiteD& s1, const CSiteD& d0, const CSiteD& d1) : 
  157. m_mtx(s1 - s0, (s1 - s0).rot90 (), d1 - d0, (d1 - d0).rot90 ()),
  158. m_stdSrc (s0), 
  159. m_stdDst (d0)
  160. {
  161. }
  164. CAffine2D::CAffine2D (
  165. const CSiteD& s, const CVector2D& sv0, const CVector2D& sv1, 
  166. const CSiteD& d, const CVector2D& dv0, const CVector2D& dv1) : 
  167. m_mtx(sv0, sv1, dv0, dv1), m_stdSrc (s), m_stdDst (d)
  168. {
  169. }
  172. CAffine2D::CAffine2D (const CSiteD source [3], const CSiteD dest [3]) : 
  173. m_mtx (
  174. source [1] - source [0], 
  175. source [2] - source [0], 
  176. dest [1] - dest [0], 
  177. dest [2] - dest [0]
  178. ),
  179. m_stdSrc (source [0]), 
  180. m_stdDst (dest [0])
  182. {
  183. }
  185. CAffine2D::CAffine2D (const CoordD params [6]) :
  186. m_mtx (CVector2D (params [0], params [3]), CVector2D (params [1], params [4])),
  187. m_stdSrc (0, 0),
  188. m_stdDst (params [2], params [5])
  189. {
  190. }
  194. CAffine2D CAffine2D::inverse () const
  195. {
  196. CAffine2D affInv; 
  197. affInv.m_mtx= m_mtx.inverse (); 
  198. affInv.m_stdSrc = m_stdDst; 
  199. affInv.m_stdDst = m_stdSrc; 
  200. return affInv; 
  201. }
  203. CAffine2D CAffine2D::setOrigin (const CSiteD& std) const
  204. {
  205.   CAffine2D r;
  206. CVector2D vec;
  207. r.m_mtx = m_mtx;
  208. vec = m_mtx.apply (std - m_stdDst);
  209. r.m_stdDst.x = std.x - vec.x;
  210. r.m_stdDst.y = std.y - vec.y;
  211. r.m_stdSrc = m_stdSrc;
  212. return r;
  213. }
  216. Void CAffine2D::getParams (CoordD params [6]) const
  217. {
  218. params [0] = m_mtx.element (0, 0);
  219. params [1] = m_mtx.element (0, 1);
  220. params [3] = m_mtx.element (1, 0);
  221. params [4] = m_mtx.element (1, 1);
  222. params [2] = m_stdDst.x - params [0] * m_stdSrc.x - params [1] * m_stdSrc.y;
  223. params [5] = m_stdDst.y - params [3] * m_stdSrc.x - params [4] * m_stdSrc.y;
  225. }
  228. CPerspective2D::~CPerspective2D ()
  229. {
  230. delete [] m_rgCoeff;
  231. }
  233. CPerspective2D::CPerspective2D ()
  234. {
  235. m_rgCoeff = NULL;
  236. }
  238. CPerspective2D::CPerspective2D (const UInt pntNum, const CSiteD source [4], const CSiteD dest [4], const UInt accuracy) : m_rgCoeff (NULL)
  239. {
  240. UInt uiScale = 1 << (accuracy + 1);
  241. m_x0 = source [0].x;
  242. m_y0 = source [0].y;
  243. m_rgCoeff = new Double [9];
  244. Double x [4], dx [4], y [4], dy [4], a[4][4];
  245. for (UInt k = 0; k < pntNum; k++) {
  246. m_rgstdSrc [k] = source [k];
  247. m_rgstdDst [k] = dest [k] * uiScale;
  248. x [k] = m_rgstdDst [k].x; 
  249. y [k] = m_rgstdDst [k].y;
  250. }
  252. Int width = (Int) (m_rgstdSrc [1].x - m_rgstdSrc [0].x);
  253. Int height = (Int) (m_rgstdSrc [2].y - m_rgstdSrc [0].y);
  254. if (pntNum == 1) {
  255. a[1][1] = (Double) uiScale;
  256. a[2][1] = 0;
  257. a[3][1] = x [0];
  258. a[1][2] = 0;
  259. a[2][2] = (Double) uiScale;
  260. a[3][2] = y [0];
  261. a[1][3] = 0;
  262. a[2][3] = 0;
  263. a[3][3] = 1.0;
  264. } else if (pntNum == 2) {
  265. a[1][1] = (x [1] - x [0]) ;
  266. a[2][1] = (y [0] - y [1]) ;
  267. a[3][1] = x [0] * width;
  268. a[1][2] = (y [1] - y [0]) ;
  269. a[2][2] = (x [1] - x [0]) ;
  270. a[3][2] = y [0] * width;
  271. a[1][3] = 0;
  272. a[2][3] = 0;
  273. a[3][3] = width;
  274. } else if (pntNum == 3) {
  275. a[1][1] = (x [1] - x [0]) * height;
  276. a[2][1] = (x [2] - x [0]) * width;
  277. a[3][1] = x [0] * height * width;
  278. a[1][2] = (y [1] - y [0]) * height;
  279. a[2][2] = (y [2] - y [0]) * width;
  280. a[3][2] = y [0] * height * width;
  281. a[1][3] = 0;
  282. a[2][3] = 0;
  283. a[3][3] = height * width;
  284. } else if (pntNum == 4) {
  285. dx [1] = x [1] - x [3]; dx [2] = x [2] - x [3]; dx [3] = x [0] - x [1] + x [3] - x [2];
  286. dy [1] = y [1] - y [3]; dy [2] = y [2] - y [3]; dy [3] = y [0] - y [1] + y [3] - y [2];
  287. if ((dx [3] == 0 && dy [3] == 0) || pntNum == 3) {
  288. a[1][1] = (x [1] - x [0]) * height;
  289. a[2][1] = (x [2] - x [0]) * width;
  290. a[3][1] = x [0] * height * width;
  291. a[1][2] = (y [1] - y [0]) * height;
  292. a[2][2] = (y [2] - y [0]) * width;
  293. a[3][2] = y [0] * height * width;
  294. a[1][3] = 0;
  295. a[2][3] = 0;
  296. a[3][3] = height * width;
  297. } else {
  298. Double deltaD = dx [1] * dy [2] - dx [2] * dy [1];
  299. a[1][3] = (dx [3] * dy [2] - dx [2] * dy [3]) * height;
  300. a[2][3] = (dx [1] * dy [3] - dx [3] * dy [1]) * width;
  301. a[1][1] = (x [1] - x [0]) * height * deltaD + a[1][3] * x [1];
  302. a[2][1] = (x [2] - x [0]) * width * deltaD + a[2][3] * x [2];
  303. a[3][1] = x [0] * height * width * deltaD;
  304. a[1][2] = (y [1] - y [0]) * deltaD * height + a[1][3] * y [1];
  305. a[2][2] = (y [2] - y [0]) * deltaD * width + a[2][3] * y [2];
  306. a[3][2] = y [0] * height * width * deltaD;
  307. a[3][3] = height * width * deltaD;
  308. }
  309. }
  310. m_rgCoeff [0] = a[1][1];
  311. m_rgCoeff [1] = a[2][1];
  312. m_rgCoeff [2] = a[3][1];
  313. m_rgCoeff [3] = a[1][2];
  314. m_rgCoeff [4] = a[2][2];
  315. m_rgCoeff [5] = a[3][2];
  316. m_rgCoeff [6] = a[1][3];
  317. m_rgCoeff [7] = a[2][3];
  318. m_rgCoeff [8] = a[3][3];
  319. }
  321. CPerspective2D::CPerspective2D (const CSiteD source [4], const CSiteD dest [4]) : m_rgCoeff (NULL)
  322. {
  323. m_x0 = m_y0 = 0.0;
  324. UInt pts = 4;
  325. UInt rows = 2 * pts, cols = 8, i, j;
  326. for (i = 0; i < 4; i++) {
  327. m_rgstdSrc [i] = source [i];
  328. m_rgstdDst [i] = dest [i];
  329. }
  331. Double* B = new Double [rows];
  332. Double** A = (Double**) new Double* [rows]; 
  333. for (i = 0; i < rows; i++)
  334. A [i] =  new Double [cols] ;
  336. for (i = 0; i < pts; i++) {
  337.   A [i] [0] = m_rgstdSrc [i].x ;
  338. A [i] [1] = m_rgstdSrc [i].y ;
  339. A [i] [2] = 1; 
  340. A [i] [3] = A [i] [4] = A[i] [5] =0;
  341.   A [i] [6] = (-1) * (m_rgstdSrc [i].x * m_rgstdDst [i].x );
  342. A [i] [7] = (-1) * (m_rgstdSrc [i].y * m_rgstdDst [i].x );
  344. B [i] = m_rgstdDst [i].x;
  345. }
  347. for (i = pts, j = 0; i < rows; i++, j++) {
  348. A [i] [0] = A [i] [1] = A [i] [2] = 0;
  349.   A [i] [3] = m_rgstdSrc [j].x ;
  350. A [i] [4] = m_rgstdSrc [j].y ;
  351. A [i] [5] = 1; 
  352.   A [i] [6] = (-1) * (m_rgstdSrc [j].x * m_rgstdDst [j].y);
  353. A [i] [7] = (-1) * (m_rgstdSrc [j].y * m_rgstdDst [j].y);
  355. B [i] = m_rgstdDst [j].y;
  356. }
  357. m_rgCoeff = linearLS (A, B, rows, cols);
  359. delete [] B;
  360. for (i = 0; i < rows; i++)
  361. delete [] A [i];
  363. delete [] A;
  364. }
  366. CPerspective2D::CPerspective2D (Double* rgCoeff) : m_rgCoeff (NULL)
  367. {
  368. m_rgCoeff = new Double [8];
  369. UInt i;
  370. for (i = 0; i < 8; i++) 
  371. m_rgCoeff [i] = rgCoeff [i];
  372. m_rgstdSrc [0] = CSiteD (0, 0);
  373. m_rgstdSrc [1] = CSiteD (176, 0);
  374. m_rgstdSrc [2] = CSiteD (0, 144);
  375. m_rgstdSrc [3] = CSiteD (176, 144);
  376. for (i = 0; i < 4; i++) {
  377. m_rgstdDst [i] = (*this * m_rgstdSrc [i]).s;
  378. }
  379. }
  381. CSiteDWFlag CPerspective2D::apply (const CSiteD& s0) const
  382. {
  383. Double destX, destY, destW;
  384. CSiteDWFlag destST; 
  386. destX = (s0.x - m_x0) * m_rgCoeff [0] + (s0.y - m_y0) * m_rgCoeff [1] + m_rgCoeff [2];
  387. destY = (s0.x - m_x0 ) * m_rgCoeff [3] + (s0.y - m_y0 ) * m_rgCoeff [4] + m_rgCoeff [5]; 
  388. destW = (s0.x - m_x0) * m_rgCoeff [6] + (s0.y - m_y0) * m_rgCoeff [7] + m_rgCoeff [8]; 
  389. if (destW != 0.0) {
  390. destST.s.x = destX / destW; 
  391. destST.s.y = destY / destW; 
  392. destST.f = FALSE;
  393. } else    // destW == 0.0
  394. destST.f = TRUE;
  396. return destST;
  397. }
  399. CSiteWFlag CPerspective2D::apply (const CSite& s0) const
  400. {
  401. Double destX, destY, destW;
  402. CSiteWFlag destST; 
  404. destX = (s0.x - m_x0) * m_rgCoeff [0] + (s0.y - m_y0) * m_rgCoeff [1] + m_rgCoeff [2];
  405. destY = (s0.x - m_x0 ) * m_rgCoeff [3] + (s0.y - m_y0 ) * m_rgCoeff [4] + m_rgCoeff [5]; 
  406. destW = (s0.x - m_x0) * m_rgCoeff [6] + (s0.y - m_y0) * m_rgCoeff [7] + m_rgCoeff [8];
  408. if (destW != 0.0) {
  409. if ((destX >= 0 && destW > 0) || (destX <= 0 && destW < 0)) {
  410. destST.s.x = (CoordI) ((destX + destW / 2) / destW);
  411. } else {
  412. if (destX > 0 && destW < 0) {
  413. destST.s.x = (CoordI) ((destX - (destW + 1) / 2) / destW);
  414. } else {
  415. destST.s.x = (CoordI) ((destX - (destW - 1) / 2) / destW);
  416. }
  417. }
  418. if ((destY >= 0 && destW > 0) || (destY <= 0 && destW < 0)) {
  419. destST.s.y = (CoordI) ((destY + destW / 2) / destW);
  420. } else {
  421. if (destY > 0 && destW < 0) {
  422. destST.s.y = (CoordI) ((destY - (destW + 1) / 2) / destW);
  423. } else {
  424. destST.s.y = (CoordI) ((destY - (destW - 1) / 2) / destW);
  425. }
  426. }
  427. destST.f = FALSE;
  428. } else    // destW == 0.0
  429. destST.f = TRUE;
  431. return destST; 
  432. }
  434. CPerspective2D CPerspective2D::inverse () const
  435. {
  436. return CPerspective2D (m_rgstdDst, m_rgstdSrc);
  437. }