transform.cc
上传用户:rrhhcc
上传日期:2015-12-11
资源大小:54129k
文件大小:7k
源码类别:

通讯编程

开发平台:

Visual C++

  1. /*
  2.  * Copyright (c) 1993 Regents of the University of California.
  3.  * All rights reserved.
  4.  *
  5.  * Redistribution and use in source and binary forms, with or without
  6.  * modification, are permitted provided that the following conditions
  7.  * are met:
  8.  * 1. Redistributions of source code must retain the above copyright
  9.  *    notice, this list of conditions and the following disclaimer.
  10.  * 2. Redistributions in binary form must reproduce the above copyright
  11.  *    notice, this list of conditions and the following disclaimer in the
  12.  *    documentation and/or other materials provided with the distribution.
  13.  * 3. All advertising materials mentioning features or use of this software
  14.  *    must display the following acknowledgement:
  15.  * This product includes software developed by the Computer Systems
  16.  * Engineering Group at Lawrence Berkeley Laboratory.
  17.  * 4. Neither the name of the University nor of the Laboratory may be used
  18.  *    to endorse or promote products derived from this software without
  19.  *    specific prior written permission.
  20.  *
  21.  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  22.  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  23.  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  24.  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  25.  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  26.  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  27.  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  28.  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  29.  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  30.  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  31.  * SUCH DAMAGE.
  32.  *
  33.  * This code derived from InterViews library which is covered
  34.  * by the copyright below.
  35.  */
  36. /*
  37.  * Copyright (c) 1987, 1988, 1989, 1990, 1991 Stanford University
  38.  * Copyright (c) 1991 Silicon Graphics, Inc.
  39.  *
  40.  * Permission to use, copy, modify, distribute, and sell this software and 
  41.  * its documentation for any purpose is hereby granted without fee, provided
  42.  * that (i) the above copyright notices and this permission notice appear in
  43.  * all copies of the software and related documentation, and (ii) the names of
  44.  * Stanford and Silicon Graphics may not be used in any advertising or
  45.  * publicity relating to the software without the specific, prior written
  46.  * permission of Stanford and Silicon Graphics.
  47.  * 
  48.  * THE SOFTWARE IS PROVIDED "AS-IS" AND WITHOUT WARRANTY OF ANY KIND, 
  49.  * EXPRESS, IMPLIED OR OTHERWISE, INCLUDING WITHOUT LIMITATION, ANY 
  50.  * WARRANTY OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE.  
  51.  *
  52.  * IN NO EVENT SHALL STANFORD OR SILICON GRAPHICS BE LIABLE FOR
  53.  * ANY SPECIAL, INCIDENTAL, INDIRECT OR CONSEQUENTIAL DAMAGES OF ANY KIND,
  54.  * OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS,
  55.  * WHETHER OR NOT ADVISED OF THE POSSIBILITY OF DAMAGE, AND ON ANY THEORY OF 
  56.  * LIABILITY, ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE 
  57.  * OF THIS SOFTWARE.
  58.  */
  59. /*
  60.  * Implementation of transformation matrix operations.
  61.  */
  62. #include "sincos.h"
  63. #include "transform.h"
  64. static const double RADPERDEG = M_PI/180.0;
  65. Transform::Transform()
  66. {
  67. clear();
  68. }
  69. void Transform::clear()
  70. {
  71. identity_ = 1;
  72. mat00 = mat11 = 1;
  73. mat01 = mat10 = mat20 = mat21 = 0;
  74. }
  75. Transform::Transform(const Transform& t)
  76. {
  77. mat00 = t.mat00; mat01 = t.mat01;
  78. mat10 = t.mat10; mat11 = t.mat11;
  79. mat20 = t.mat20; mat21 = t.mat21;
  80. update();
  81. }
  82. Transform::Transform(float a00, float a01, float a10,
  83.      float a11, float a20, float a21)
  84. {
  85. mat00 = a00; mat01 = a01;
  86. mat10 = a10; mat11 = a11;
  87. mat20 = a20; mat21 = a21;
  88. update();
  89. }
  90. int Transform::operator ==(const Transform& t) const
  91. {
  92. if (identity_)
  93. return t.identity_;
  94. if (t.identity_)
  95. return (0);
  96. return (mat00 == t.mat00 && mat01 == t.mat01 &&
  97. mat10 == t.mat10 && mat11 == t.mat11 &&
  98. mat20 == t.mat20 && mat21 == t.mat21);
  99. }
  100. int Transform::operator !=(const Transform& t) const
  101. {
  102. if (identity_)
  103. return (!t.identity_);
  104. if (t.identity_)
  105. return (1);
  106. return (mat00 != t.mat00 || mat01 != t.mat01 ||
  107. mat10 != t.mat10 || mat11 != t.mat11 ||
  108. mat20 != t.mat20 || mat21 != t.mat21);
  109. }
  110. Transform& Transform::operator =(const Transform& t)
  111. {
  112. mat00 = t.mat00;
  113. mat01 = t.mat01;
  114. mat10 = t.mat10;
  115. mat11 = t.mat11;
  116. mat20 = t.mat20;
  117. mat21 = t.mat21;
  118. update();
  119. return (*this);
  120. }
  121. void Transform::update()
  122. {
  123. identity_ = (
  124.      mat00 == 1 && mat11 == 1 &&
  125.      mat01 == 0 && mat10 == 0 && mat20 == 0 && mat21 == 0
  126.      );
  127. }
  128. void Transform::translate(float dx, float dy)
  129. {
  130. mat20 += dx;
  131. mat21 += dy;
  132. update();
  133. }
  134. void Transform::scale(float sx, float sy)
  135. {
  136. mat00 *= sx;
  137. mat01 *= sy;
  138. mat10 *= sx;
  139. mat11 *= sy;
  140. mat20 *= sx;
  141. mat21 *= sy;
  142. update();
  143. }
  144. void Transform::skew(float sx, float sy)
  145. {
  146. mat01 += mat00*sy;
  147. mat10 += mat11*sx;
  148.     update();
  149. }
  150. void Transform::rotate(float angle)
  151. {
  152. float tmp1, tmp2, m00, m01, m10, m11, m20, m21;
  153. angle *= RADPERDEG;
  154. tmp1 = cos(angle);
  155. tmp2 = sin(angle);
  156.     
  157. m00 = mat00*tmp1;
  158. m01 = mat01*tmp2;
  159. m10 = mat10*tmp1;
  160. m11 = mat11*tmp2;
  161. m20 = mat20*tmp1;
  162. m21 = mat21*tmp2;
  163. mat01 = mat00*tmp2 + mat01*tmp1;
  164. mat11 = mat10*tmp2 + mat11*tmp1;
  165. mat21 = mat20*tmp2 + mat21*tmp1;
  166. mat00 = m00 - m01;
  167. mat10 = m10 - m11;
  168. mat20 = m20 - m21;
  169. update();
  170. }
  171. void Transform::premultiply(const Transform& t)
  172. {
  173. float tmp1 = mat00;
  174. float tmp2 = mat10;
  175. mat00  = t.mat00*tmp1 + t.mat01*tmp2;
  176. mat10  = t.mat10*tmp1 + t.mat11*tmp2;
  177. mat20 += t.mat20*tmp1 + t.mat21*tmp2;
  178. tmp1 = mat01;
  179. tmp2 = mat11;
  180. mat01  = t.mat00*tmp1 + t.mat01*tmp2;
  181. mat11  = t.mat10*tmp1 + t.mat11*tmp2;
  182. mat21 += t.mat20*tmp1 + t.mat21*tmp2;
  183. update();
  184. }
  185. void Transform::postmultiply(const Transform& t)
  186. {
  187. float tmp = mat00*t.mat01 + mat01*t.mat11;
  188. mat00 = mat00*t.mat00 + mat01*t.mat10;
  189. mat01 = tmp;
  190. tmp = mat10*t.mat01 + mat11*t.mat11;
  191. mat10 = mat10*t.mat00 + mat11*t.mat10;
  192. mat11 = tmp;
  193. tmp = mat20*t.mat01 + mat21*t.mat11;
  194. mat20 = mat20*t.mat00 + mat21*t.mat10;
  195. mat21 = tmp;
  196. mat20 += t.mat20;
  197. mat21 += t.mat21;
  198. update();
  199. }    
  200. void Transform::invert()
  201. {
  202. float d = det();
  203. float t00 = mat00;
  204. float t20 = mat20;
  205. mat20 = (mat10*mat21 - mat11*mat20)/d;
  206. mat21 = (mat01*t20 - mat00*mat21)/d;
  207. mat00 = mat11/d;
  208. mat11 = t00/d;
  209. mat10 = -mat10/d;
  210. mat01 = -mat01/d;
  211. update();
  212. }
  213. void Transform::map(float& x, float& y) const
  214. {
  215. float tx = x;
  216. x = tx*mat00 + y*mat10 + mat20;
  217. y = tx*mat01 + y*mat11 + mat21;
  218. }
  219. void Transform::map(float x, float y, float& tx, float& ty) const
  220. {
  221. tx = x*mat00 + y*mat10 + mat20;
  222. ty = x*mat01 + y*mat11 + mat21;
  223. }
  224. void Transform::imap(float& tx, float& ty) const
  225. {
  226. float d = det();
  227. float a = (tx - mat20) / d;
  228. float b = (ty - mat21) / d;
  229. tx = a*mat11 - b*mat10;
  230. ty = b*mat00 - a*mat01;
  231. }
  232. void Transform::imap(float tx, float ty, float& x, float& y) const
  233. {
  234. float d = det();
  235. float a = (tx - mat20) / d;
  236. float b = (ty - mat21) / d;
  237. x = a*mat11 - b*mat10;
  238. y = b*mat00 - a*mat01;
  239. }