GUIPolyE.c
上传用户:zbk8730
上传日期:2017-08-10
资源大小:12168k
文件大小:3k
源码类别:

uCOS

开发平台:

C/C++

  1. /*
  2. *********************************************************************************************************
  3. *                                                uC/GUI
  4. *                        Universal graphic software for embedded applications
  5. *
  6. *                       (c) Copyright 2002, Micrium Inc., Weston, FL
  7. *                       (c) Copyright 2002, SEGGER Microcontroller Systeme GmbH
  8. *
  9. *              礐/GUI is protected by international copyright laws. Knowledge of the
  10. *              source code may not be used to write a similar product. This file may
  11. *              only be used in accordance with a license and should not be redistributed
  12. *              in any way. We appreciate your understanding and fairness.
  13. *
  14. ----------------------------------------------------------------------
  15. File        : GUIPolyE.c
  16. Purpose     : Polygon enlarge
  17. ----------------------------------------------------------------------
  18. */
  19. #include <math.h>
  20. #include "GUI.H"
  21. #include "GUIDebug.H"
  22. typedef struct {
  23.   float x,y;
  24. } tfPoint;
  25. static int fround ( float f) {
  26.   if (f>0)
  27.     return f+0.5;
  28.   return f-0.5;
  29. }
  30. static void Normalize(tfPoint* pfPoint) {
  31.   float fx = pfPoint->x;
  32.   float fy = pfPoint->y;
  33.   float r = sqrt(fx*fx + fy*fy);
  34.   if (r > 0) {
  35.     pfPoint->x = fx/r;
  36.     pfPoint->y = fy/r;
  37.   }
  38. }
  39. static void ReverseLen(tfPoint* pfPoint) {
  40.   float fx = pfPoint->x;
  41.   float fy = pfPoint->y;
  42.   float r = sqrt(fx*fx/2 + fy*fy/2);
  43.   if (r > 0) {
  44.     pfPoint->x = fx/r/r;
  45.     pfPoint->y = fy/r/r;
  46.   }
  47. }
  48. static void GetVect(tfPoint* pfPoint, const GUI_POINT* pSrc, int NumPoints, int Index) {
  49.   int Off0 = (Index + NumPoints-1) % NumPoints;
  50.   int Off1 = Index % NumPoints;
  51.   pfPoint->x = pSrc[Off1].x - pSrc[Off0].x; 
  52.   pfPoint->y = pSrc[Off1].y - pSrc[Off0].y; 
  53. }
  54. /*******************************************************************
  55. *
  56. *                  GUI_EnlargePolygon
  57. *
  58. ********************************************************************
  59. */
  60. #if 0
  61. void GUI_EnlargePolygon(GUI_POINT* pDest, const GUI_POINT* pSrc, int NumPoints, int Len) {
  62.   int j;
  63.   /* Calc destination points */
  64.   for (j=0; j<NumPoints; j++) {
  65.     int x, y;
  66.     tfPoint aVect[2];
  67.     /* Get the vectors */
  68.     GetVect(&aVect[0], pSrc, NumPoints, j);
  69.     GetVect(&aVect[1], pSrc, NumPoints, j+1);
  70.     /* Normalize the vectors and add vectors */
  71.     Normalize(&aVect[0]);
  72.     Normalize(&aVect[1]);
  73.     aVect[0].x += aVect[1].x;
  74.     aVect[0].y += aVect[1].y;
  75.     /* Resulting vector needs to be normalized again */
  76.     Normalize(&aVect[0]);
  77.     x =  fround(aVect[0].y * Len);
  78.     y = -fround(aVect[0].x * Len);
  79.     /* Store destination */
  80.     (pDest+j)->x = (pSrc+j)->x + x;
  81.     (pDest+j)->y = (pSrc+j)->y + y;
  82.   }
  83. }
  84. #else
  85. void GUI_EnlargePolygon(GUI_POINT* pDest, const GUI_POINT* pSrc, int NumPoints, int Len) {
  86.   int j;
  87.   /* Calc destination points */
  88.   for (j=0; j<NumPoints; j++) {
  89.     int x, y;
  90.     tfPoint aVect[2];
  91.     /* Get the vectors */
  92.     GetVect(&aVect[0], pSrc, NumPoints, j);
  93.     GetVect(&aVect[1], pSrc, NumPoints, j+1);
  94.     /* Normalize the vectors and add vectors */
  95.     Normalize(&aVect[0]);
  96.     Normalize(&aVect[1]);
  97.     aVect[0].x += aVect[1].x;
  98.     aVect[0].y += aVect[1].y;
  99.     /* Resulting vector needs to be normalized again */
  100.     ReverseLen(&aVect[0]);
  101.     x =  fround(aVect[0].y * Len);
  102.     y = -fround(aVect[0].x * Len);
  103.     /* Store destination */
  104.     (pDest+j)->x = (pSrc+j)->x + x;
  105.     (pDest+j)->y = (pSrc+j)->y + y;
  106.   }
  107. }
  108. #endif