+ T interpolate (double dAngle, double dPos)
+{
+ int iFloorAngle = static_cast<int>(floor(dAngle));
+ int iFloorPos = static_cast<int>(floor (dPos));
+ double dAngleFrac = dAngle - iFloorAngle;
+ double dPosFrac = dPos - iFloorPos;
+
+ T result = 0;
+
+ if (iFloorAngle < -1 || iFloorPos < 0 || iFloorAngle > m_nAngle-1 || iFloorPos > m_nPos-1)
+ result = 0;
+ else if (iFloorAngle == -1 && iFloorPos == m_nPos-1)
+ result = static_cast<T>(m_ppMatrix[0][m_nPos-1] + dAngleFrac * (m_ppMatrix[m_nAngle-1][iFloorPos] - m_ppMatrix[0][iFloorPos]));
+ else if (iFloorAngle == m_nAngle - 1 && iFloorPos == m_nPos-1)
+ result = static_cast<T>(m_ppMatrix[m_nAngle-1][m_nPos-1] + dAngleFrac * (m_ppMatrix[0][iFloorPos] - m_ppMatrix[m_nAngle-1][iFloorPos]));
+ else if (iFloorPos == m_nPos - 1)
+ result = static_cast<T>(m_ppMatrix[iFloorAngle][iFloorPos] + dAngleFrac * (m_ppMatrix[iFloorAngle+1][iFloorPos] - m_ppMatrix[iFloorAngle][iFloorPos]));
+ else {
+ if (iFloorAngle == m_nAngle-1) {
+ int iUpperAngle = 0;
+ int iLowerPos = (m_nPos-1) - iFloorPos;
+ int iUpperPos = (m_nPos-1) - (iFloorPos+1);
+ result = static_cast<T>
+ ((1-dAngleFrac) * (1-dPosFrac) * m_ppMatrix[iFloorAngle][iFloorPos] +
+ dAngleFrac * (1-dPosFrac) * m_ppMatrix[iUpperAngle][iLowerPos] +
+ dPosFrac * (1-dAngleFrac) * m_ppMatrix[iFloorAngle][iFloorPos+1] +
+ dAngleFrac * dPosFrac * m_ppMatrix[iUpperAngle][iUpperPos]);
+ } else if (iFloorAngle == -1) {
+ int iLowerAngle = m_nAngle - 1;
+ int iLowerPos = (m_nPos-1) - iFloorPos;
+ int iUpperPos = (m_nPos-1) - (iFloorPos+1);
+ result = static_cast<T>
+ ((1-dAngleFrac) * (1-dPosFrac) * m_ppMatrix[iLowerAngle][iLowerPos] +
+ dAngleFrac * (1-dPosFrac) * m_ppMatrix[iFloorAngle+1][iFloorPos] +
+ dPosFrac * (1-dAngleFrac) * m_ppMatrix[iLowerAngle][iUpperPos] +
+ dAngleFrac * dPosFrac * m_ppMatrix[iFloorAngle+1][iFloorPos+1]);
+ } else
+ result = static_cast<T>
+ ((1-dAngleFrac) * (1-dPosFrac) * m_ppMatrix[iFloorAngle][iFloorPos] +
+ dAngleFrac * (1-dPosFrac) * m_ppMatrix[iFloorAngle+1][iFloorPos] +
+ dPosFrac * (1-dAngleFrac) * m_ppMatrix[iFloorAngle][iFloorPos+1] +
+ dAngleFrac * dPosFrac * m_ppMatrix[iFloorAngle+1][iFloorPos+1]);