<!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "http://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd"> <html xmlns="http://www.w3.org/1999/xhtml"> <head> <meta http-equiv="Content-Type" content="text/html;charset=UTF-8"/> <title>libkate: /home/v/Kate/WORK_TREES/kate-sorceress-backup/v/src/kate/src/kate_motion.c Source File</title> <link href="tabs.css" rel="stylesheet" type="text/css"/> <link href="doxygen.css" rel="stylesheet" type="text/css"/> </head> <body> <!-- Generated by Doxygen 1.6.0 --> <div class="navigation" id="top"> <div class="tabs"> <ul> <li><a href="index.html"><span>Main Page</span></a></li> <li><a href="pages.html"><span>Related Pages</span></a></li> <li><a href="annotated.html"><span>Data Structures</span></a></li> <li class="current"><a href="files.html"><span>Files</span></a></li> <li><a href="examples.html"><span>Examples</span></a></li> </ul> </div> <div class="tabs"> <ul> <li><a href="files.html"><span>File List</span></a></li> </ul> </div> <h1>/home/v/Kate/WORK_TREES/kate-sorceress-backup/v/src/kate/src/kate_motion.c</h1><div class="fragment"><pre class="fragment"><a name="l00001"></a>00001 <span class="comment">/* Copyright (C) 2008 Vincent Penquerc'h.</span> <a name="l00002"></a>00002 <span class="comment"> This file is part of the Kate codec library.</span> <a name="l00003"></a>00003 <span class="comment"> Written by Vincent Penquerc'h.</span> <a name="l00004"></a>00004 <span class="comment"></span> <a name="l00005"></a>00005 <span class="comment"> Use, distribution and reproduction of this library is governed</span> <a name="l00006"></a>00006 <span class="comment"> by a BSD style source license included with this source in the</span> <a name="l00007"></a>00007 <span class="comment"> file 'COPYING'. Please read these terms before distributing. */</span> <a name="l00008"></a>00008 <a name="l00009"></a>00009 <a name="l00010"></a>00010 <span class="preprocessor">#define KATE_INTERNAL</span> <a name="l00011"></a>00011 <span class="preprocessor"></span><span class="preprocessor">#include "kate_internal.h"</span> <a name="l00012"></a>00012 <a name="l00013"></a>00013 <span class="preprocessor">#ifdef HAVE_STDLIB_H</span> <a name="l00014"></a>00014 <span class="preprocessor"></span><span class="preprocessor">#include <stdlib.h></span> <a name="l00015"></a>00015 <span class="preprocessor">#endif</span> <a name="l00016"></a>00016 <span class="preprocessor"></span><span class="preprocessor">#include "kate/kate.h"</span> <a name="l00017"></a>00017 <a name="l00018"></a>00018 <span class="keyword">static</span> kate_float kate_catmull_rom(kate_float t,<span class="keyword">const</span> kate_float *pts,<span class="keywordtype">int</span> k0,<span class="keywordtype">int</span> k1,<span class="keywordtype">int</span> k2,<span class="keywordtype">int</span> k3) <a name="l00019"></a>00019 { <a name="l00020"></a>00020 <span class="keyword">const</span> kate_float t2=t*t,t3=t2*t; <a name="l00021"></a>00021 <a name="l00022"></a>00022 <span class="keywordflow">return</span> ( <a name="l00023"></a>00023 (2*pts[k1*2]) <a name="l00024"></a>00024 + t * (pts[k2*2]-pts[k0*2]) <a name="l00025"></a>00025 + t2 * (-pts[k3*2]+4*pts[k2*2]-5*pts[k1*2]+2*pts[k0*2]) <a name="l00026"></a>00026 + t3 * (pts[k3*2]-3*pts[k2*2]+3*pts[k1*2]-pts[k0*2]) <a name="l00027"></a>00027 )/2; <a name="l00028"></a>00028 } <a name="l00029"></a>00029 <a name="l00030"></a>00030 <span class="keyword">static</span> kate_float kate_bezier_cubic(kate_float t,<span class="keyword">const</span> kate_float *pts) <a name="l00031"></a>00031 { <a name="l00032"></a>00032 <span class="keyword">const</span> kate_float t2=t*t,t3=t2*t,it=1-t,it2=it*it,it3=it2*it; <a name="l00033"></a>00033 <a name="l00034"></a>00034 <span class="keywordflow">return</span> it3*pts[0*2] <a name="l00035"></a>00035 +3*t*it2*pts[1*2] <a name="l00036"></a>00036 +3*t2*it*pts[2*2] <a name="l00037"></a>00037 +t3*pts[3*2]; <a name="l00038"></a>00038 } <a name="l00039"></a>00039 <a name="l00040"></a>00040 <span class="keyword">static</span> kate_float kate_bspline(kate_float t,<span class="keyword">const</span> kate_float *pts,<span class="keywordtype">int</span> k0,<span class="keywordtype">int</span> k1,<span class="keywordtype">int</span> k2,<span class="keywordtype">int</span> k3) <a name="l00041"></a>00041 { <a name="l00042"></a>00042 <span class="keyword">const</span> kate_float t2=t*t,t3=t2*t,it=1-t,it2=it*it,it3=it2*it; <a name="l00043"></a>00043 <a name="l00044"></a>00044 <span class="keywordflow">return</span> ( <a name="l00045"></a>00045 it3*pts[k0*2] <a name="l00046"></a>00046 +(3*t3-6*t2+4)*pts[k1*2] <a name="l00047"></a>00047 +(-3*t3+3*t2+3*t+1)*pts[k2*2] <a name="l00048"></a>00048 +t3*pts[k3*2] <a name="l00049"></a>00049 )/6; <a name="l00050"></a>00050 } <a name="l00051"></a>00051 <a name="l00063"></a>00063 <span class="keywordtype">int</span> kate_curve_get_point(<span class="keyword">const</span> kate_curve *kc,kate_float t,kate_float *x,kate_float *y) <a name="l00064"></a>00064 { <a name="l00065"></a>00065 <span class="keywordtype">int</span> nsegs,n; <a name="l00066"></a>00066 kate_float T,t0,t1; <a name="l00067"></a>00067 <a name="l00068"></a>00068 <span class="keywordflow">if</span> (!kc) <span class="keywordflow">return</span> KATE_E_INVALID_PARAMETER; <a name="l00069"></a>00069 <span class="keywordflow">if</span> (t<(kate_float)-0.001 || t>(kate_float)1.001) <span class="keywordflow">return</span> KATE_E_INVALID_PARAMETER; <a name="l00070"></a>00070 <span class="keywordflow">if</span> (t<0) t=0; <a name="l00071"></a>00071 <span class="keywordflow">if</span> (t>1) t=1; <a name="l00072"></a>00072 <span class="comment">/* x and y may be NULL */</span> <a name="l00073"></a>00073 <a name="l00074"></a>00074 <span class="keywordflow">switch</span> (kc->type) { <a name="l00075"></a>00075 <span class="keywordflow">case</span> kate_curve_none: <a name="l00076"></a>00076 <span class="comment">/* the motion can be discontinuous */</span> <a name="l00077"></a>00077 <span class="keywordflow">return</span> 1; <a name="l00078"></a>00078 <a name="l00079"></a>00079 <span class="keywordflow">case</span> kate_curve_static: <a name="l00080"></a>00080 <span class="keywordflow">if</span> (x) *x=kc->pts[0]; <a name="l00081"></a>00081 <span class="keywordflow">if</span> (y) *y=kc->pts[1]; <a name="l00082"></a>00082 <span class="keywordflow">return</span> 0; <a name="l00083"></a>00083 <a name="l00084"></a>00084 <span class="keywordflow">case</span> kate_curve_linear: <a name="l00085"></a>00085 <span class="comment">/* find the segment we're on */</span> <a name="l00086"></a>00086 nsegs=kc->npts-1; <a name="l00087"></a>00087 <span class="keywordflow">if</span> (nsegs<1) <span class="keywordflow">return</span> KATE_E_INIT; <a name="l00088"></a>00088 n=t*nsegs; <a name="l00089"></a>00089 <span class="comment">/* ensure it doesn't overflow */</span> <a name="l00090"></a>00090 <span class="keywordflow">if</span> (n<0) n=0; <a name="l00091"></a>00091 <span class="keywordflow">if</span> (n>=nsegs) n=nsegs-1; <a name="l00092"></a>00092 <span class="comment">/* get a 0-1 t on this segment */</span> <a name="l00093"></a>00093 t0=n/(kate_float)nsegs; <a name="l00094"></a>00094 t1=(n+1)/(kate_float)nsegs; <a name="l00095"></a>00095 T=(t-t0)/(t1-t0); <a name="l00096"></a>00096 <span class="keywordflow">if</span> (x) *x=T*kc->pts[(n+1)*2+0]+(1-T)*kc->pts[n*2+0]; <a name="l00097"></a>00097 <span class="keywordflow">if</span> (y) *y=T*kc->pts[(n+1)*2+1]+(1-T)*kc->pts[n*2+1]; <a name="l00098"></a>00098 <span class="keywordflow">return</span> 0; <a name="l00099"></a>00099 <a name="l00100"></a>00100 <span class="keywordflow">case</span> kate_curve_catmull_rom_spline: <a name="l00101"></a>00101 <span class="comment">/* find the segment we're on */</span> <a name="l00102"></a>00102 nsegs=kc->npts-1; <span class="comment">/* one segment less than points */</span> <a name="l00103"></a>00103 <span class="keywordflow">if</span> (nsegs<1) <span class="keywordflow">return</span> KATE_E_INIT; <a name="l00104"></a>00104 n=t*nsegs; <a name="l00105"></a>00105 <span class="comment">/* ensure it doesn't overflow */</span> <a name="l00106"></a>00106 <span class="keywordflow">if</span> (n<0) n=0; <a name="l00107"></a>00107 <span class="keywordflow">if</span> (n>=nsegs) n=nsegs-1; <a name="l00108"></a>00108 <span class="comment">/* get a 0-1 t on this segment */</span> <a name="l00109"></a>00109 t0=n/(kate_float)nsegs; <a name="l00110"></a>00110 t1=(n+1)/(kate_float)nsegs; <a name="l00111"></a>00111 T=(t-t0)/(t1-t0); <a name="l00112"></a>00112 { <a name="l00113"></a>00113 <span class="keywordtype">int</span> k0=n-1; <a name="l00114"></a>00114 <span class="keywordtype">int</span> k1=n; <a name="l00115"></a>00115 <span class="keywordtype">int</span> k2=n+1; <a name="l00116"></a>00116 <span class="keywordtype">int</span> k3=n+2; <a name="l00117"></a>00117 <span class="keywordflow">if</span> (n==0) k0=n; <a name="l00118"></a>00118 <span class="keywordflow">if</span> (n==nsegs-1) k3=n+1; <a name="l00119"></a>00119 <span class="keywordflow">if</span> (x) *x=kate_catmull_rom(T,kc->pts,k0,k1,k2,k3); <a name="l00120"></a>00120 <span class="keywordflow">if</span> (y) *y=kate_catmull_rom(T,kc->pts+1,k0,k1,k2,k3); <a name="l00121"></a>00121 } <a name="l00122"></a>00122 <span class="keywordflow">return</span> 0; <a name="l00123"></a>00123 <a name="l00124"></a>00124 <span class="keywordflow">case</span> kate_curve_bezier_cubic_spline: <a name="l00125"></a>00125 <span class="comment">/* find the segment we're on */</span> <a name="l00126"></a>00126 <span class="keywordflow">if</span> (kc->npts<4) <span class="keywordflow">return</span> KATE_E_INIT; <a name="l00127"></a>00127 <span class="keywordflow">if</span> ((kc->npts-1)%3) <span class="keywordflow">return</span> KATE_E_INIT; <a name="l00128"></a>00128 nsegs=(kc->npts-1)/3; <span class="comment">/* 4 control points per segment, with one shared */</span> <a name="l00129"></a>00129 n=t*nsegs; <a name="l00130"></a>00130 <span class="comment">/* ensure it doesn't overflow */</span> <a name="l00131"></a>00131 <span class="keywordflow">if</span> (n<0) n=0; <a name="l00132"></a>00132 <span class="keywordflow">if</span> (n>=nsegs) n=nsegs-1; <a name="l00133"></a>00133 <span class="comment">/* get a 0-1 t on this segment */</span> <a name="l00134"></a>00134 t0=n/(kate_float)nsegs; <a name="l00135"></a>00135 t1=(n+1)/(kate_float)nsegs; <a name="l00136"></a>00136 T=(t-t0)/(t1-t0); <a name="l00137"></a>00137 <span class="keywordflow">if</span> (x) *x=kate_bezier_cubic(T,kc->pts+2*n*3); <a name="l00138"></a>00138 <span class="keywordflow">if</span> (y) *y=kate_bezier_cubic(T,kc->pts+2*n*3+1); <a name="l00139"></a>00139 <span class="keywordflow">return</span> 0; <a name="l00140"></a>00140 <a name="l00141"></a>00141 <span class="keywordflow">case</span> kate_curve_bspline: <a name="l00142"></a>00142 <span class="keywordflow">if</span> (kc->npts<1) <span class="keywordflow">return</span> KATE_E_INIT; <a name="l00143"></a>00143 <span class="comment">/* find the segment we're on */</span> <a name="l00144"></a>00144 nsegs=kc->npts+3; <span class="comment">/* more segments than points, end knots are 3-repeated */</span> <a name="l00145"></a>00145 <span class="keywordflow">if</span> (nsegs<1) <span class="keywordflow">return</span> KATE_E_INIT; <a name="l00146"></a>00146 n=t*nsegs; <a name="l00147"></a>00147 <span class="comment">/* ensure it doesn't overflow */</span> <a name="l00148"></a>00148 <span class="keywordflow">if</span> (n<0) n=0; <a name="l00149"></a>00149 <span class="keywordflow">if</span> (n>=nsegs) n=nsegs-1; <a name="l00150"></a>00150 <span class="comment">/* get a 0-1 t on this segment */</span> <a name="l00151"></a>00151 t0=n/(kate_float)nsegs; <a name="l00152"></a>00152 t1=(n+1)/(kate_float)nsegs; <a name="l00153"></a>00153 T=(t-t0)/(t1-t0); <a name="l00154"></a>00154 { <a name="l00155"></a>00155 <span class="keywordtype">int</span> k0=n-3; <a name="l00156"></a>00156 <span class="keywordtype">int</span> k1=k0+1; <a name="l00157"></a>00157 <span class="keywordtype">int</span> k2=k0+2; <a name="l00158"></a>00158 <span class="keywordtype">int</span> k3=k0+3; <a name="l00159"></a>00159 <span class="preprocessor">#define clamp_knot(k) do { if (k<0) k=0; if (k>=(int)kc->npts) k=kc->npts-1; } while(0)</span> <a name="l00160"></a>00160 <span class="preprocessor"></span> clamp_knot(k0); <a name="l00161"></a>00161 clamp_knot(k1); <a name="l00162"></a>00162 clamp_knot(k2); <a name="l00163"></a>00163 clamp_knot(k3); <a name="l00164"></a>00164 <span class="preprocessor">#undef clamp_knot</span> <a name="l00165"></a>00165 <span class="preprocessor"></span> <span class="keywordflow">if</span> (x) *x=kate_bspline(T,kc->pts,k0,k1,k2,k3); <a name="l00166"></a>00166 <span class="keywordflow">if</span> (y) *y=kate_bspline(T,kc->pts+1,k0,k1,k2,k3); <a name="l00167"></a>00167 } <a name="l00168"></a>00168 <span class="keywordflow">return</span> 0; <a name="l00169"></a>00169 <a name="l00170"></a>00170 <span class="keywordflow">default</span>: <a name="l00171"></a>00171 <span class="keywordflow">return</span> KATE_E_INVALID_PARAMETER; <a name="l00172"></a>00172 } <a name="l00173"></a>00173 } <a name="l00174"></a>00174 <a name="l00187"></a>00187 <span class="keywordtype">int</span> kate_motion_get_point(<span class="keyword">const</span> kate_motion *km,kate_float duration,kate_float t,kate_float *x,kate_float *y) <a name="l00188"></a>00188 { <a name="l00189"></a>00189 <span class="keywordtype">size_t</span> n; <a name="l00190"></a>00190 kate_float motion_duration; <a name="l00191"></a>00191 <a name="l00192"></a>00192 <span class="keywordflow">if</span> (!km) <span class="keywordflow">return</span> KATE_E_INVALID_PARAMETER; <a name="l00193"></a>00193 <span class="keywordflow">if</span> (duration<0) <span class="keywordflow">return</span> KATE_E_INVALID_PARAMETER; <a name="l00194"></a>00194 <span class="keywordflow">if</span> (t<0 || t>duration) <span class="keywordflow">return</span> KATE_E_INVALID_PARAMETER; <a name="l00195"></a>00195 <span class="comment">/* x and y may be NULL */</span> <a name="l00196"></a>00196 <a name="l00197"></a>00197 motion_duration=0; <a name="l00198"></a>00198 <span class="keywordflow">do</span> { <a name="l00199"></a>00199 <span class="keywordflow">for</span> (n=0;n<km->ncurves;++n) { <a name="l00200"></a>00200 kate_float curve_duration=km->durations[n]; <a name="l00201"></a>00201 <span class="keywordflow">if</span> (curve_duration<0.0) curve_duration=-curve_duration*duration; <a name="l00202"></a>00202 <span class="keywordflow">if</span> (t<=curve_duration) { <a name="l00203"></a>00203 <span class="comment">/* TODO: div by zero possible here */</span> <a name="l00204"></a>00204 <span class="keywordflow">return</span> kate_curve_get_point(km->curves[n],t/curve_duration,x,y); <a name="l00205"></a>00205 } <a name="l00206"></a>00206 t-=curve_duration; <a name="l00207"></a>00207 motion_duration+=curve_duration; <a name="l00208"></a>00208 } <a name="l00209"></a>00209 <span class="comment">/* if the motion is periodic, we loop forever */</span> <a name="l00210"></a>00210 <span class="keywordflow">if</span> (km->periodic) { <a name="l00211"></a>00211 <span class="comment">/* we now know the full duration, so we can remap t into 0..duration so next loop</span> <a name="l00212"></a>00212 <span class="comment"> will hit the point */</span> <a name="l00213"></a>00213 <span class="keywordtype">int</span> loops=t/motion_duration; <a name="l00214"></a>00214 t-=loops*motion_duration; <a name="l00215"></a>00215 } <a name="l00216"></a>00216 } <span class="keywordflow">while</span> (km->periodic); <a name="l00217"></a>00217 <a name="l00218"></a>00218 <span class="comment">/* t out of range */</span> <a name="l00219"></a>00219 <span class="keywordflow">return</span> KATE_E_INVALID_PARAMETER; <a name="l00220"></a>00220 } <a name="l00221"></a>00221 <a name="l00232"></a>00232 <span class="keywordtype">int</span> kate_motion_destroy(<span class="keyword">const</span> kate_info *ki,kate_motion **motions,<span class="keyword">const</span> <span class="keywordtype">int</span> *destroy,<span class="keywordtype">size_t</span> nmotions,<span class="keywordtype">int</span> force) <a name="l00233"></a>00233 { <a name="l00234"></a>00234 <span class="keywordtype">size_t</span> n,l; <a name="l00235"></a>00235 kate_motion *km; <a name="l00236"></a>00236 <a name="l00237"></a>00237 <span class="keywordflow">if</span> (!ki || !motions) <span class="keywordflow">return</span> KATE_E_INVALID_PARAMETER; <a name="l00238"></a>00238 <a name="l00239"></a>00239 <span class="keywordflow">for</span> (n=0;n<nmotions;++n) { <a name="l00240"></a>00240 km=motions[n]; <a name="l00241"></a>00241 <span class="keywordflow">if</span> (!km) <span class="keywordflow">continue</span>; <span class="comment">/* may have holes if referred by index */</span> <a name="l00242"></a>00242 <span class="keywordflow">if</span> (destroy && !destroy[n]) <span class="keywordflow">continue</span>; <a name="l00243"></a>00243 <span class="keywordflow">if</span> (force || kate_find_motion(ki,km)<0) { <a name="l00244"></a>00244 <span class="keywordflow">if</span> (km->curves) { <a name="l00245"></a>00245 <span class="keywordflow">for</span> (l=0;l<km->ncurves;++l) { <a name="l00246"></a>00246 kate_curve *kc=km->curves[l]; <a name="l00247"></a>00247 <span class="keywordflow">if</span> (kate_find_curve(ki,kc)<0) { <a name="l00248"></a>00248 kate_free(kc->pts); <a name="l00249"></a>00249 kate_free(kc); <a name="l00250"></a>00250 } <a name="l00251"></a>00251 } <a name="l00252"></a>00252 kate_free(km->curves); <a name="l00253"></a>00253 } <a name="l00254"></a>00254 <span class="keywordflow">if</span> (km->durations) kate_free(km->durations); <a name="l00255"></a>00255 kate_free(km); <a name="l00256"></a>00256 } <a name="l00257"></a>00257 } <a name="l00258"></a>00258 kate_free(motions); <a name="l00259"></a>00259 <a name="l00260"></a>00260 <span class="keywordflow">return</span> 0; <a name="l00261"></a>00261 } <a name="l00262"></a>00262 </pre></div></div> <hr size="1"/><address style="text-align: right;"><small>Generated on Sun Aug 21 12:55:17 2011 for libkate by <a href="http://www.doxygen.org/index.html"> <img class="footer" src="doxygen.png" alt="doxygen"/></a> 1.6.0 </small></address> </body> </html>