109{
110 LWDEBUGF(4,
"angle %.05g a1 %.05g a2 %.05g a3 %.05g zm1 %.05g zm2 %.05g zm3 %.05g",angle,a1,a2,a3,zm1,zm2,zm3);
111
112 if ( a1 < a2 )
113 {
114 if ( angle <= a2 )
115 return zm1 + (zm2-zm1) * (angle-a1) / (a2-a1);
116 else
117 return zm2 + (zm3-zm2) * (angle-a2) / (a3-a2);
118 }
119
120 else
121 {
122 if ( angle >= a2 )
123 return zm1 + (zm2-zm1) * (a1-angle) / (a1-a2);
124 else
125 return zm2 + (zm3-zm2) * (a2-angle) / (a2-a3);
126 }
127}
#define LWDEBUGF(level, msg,...)