NoPaste [TrackDrawer]

#include <windows.h>
#include <stdio.h>
#include <math.h>

#define MEMORY_LIMIT 15   // Limit of spybot's memory
#define GRID_DETAIL 15

#define GRID_COLOUR                RGB (200, 200, 200)
#define WAYPOINT_FILL_COLOUR       RGB (0,   250, 0)
#define WAYPOINT_OUTLINE_COLOUR    RGB (0,   0,   0)
#define LINES_COLOUR               RGB (0,   0,   0)

LRESULT CALLBACK WndProc (HWND, UINT, WPARAM, LPARAM) ;

void CreateHeader () ;
void SaveTrack() ;
float Diagonal (float, float) ;
     
static int          iScaleNumerator, iScaleDominator ;                  // Scale numbers (px to cm convertion)
int                 cWPoints ; 
int                 Angles[MEMORY_LIMIT], Distances[MEMORY_LIMIT] ;     // Store angles and distances between waypoints
POINT               xyWayPoints [MEMORY_LIMIT] ;                        // This array store coordinates of waypoints

int WINAPI WinMain (HINSTANCE hInstance, HINSTANCE hPrevInstance,
                    PSTR szCmdLine, int iCmdShow)
{
     static TCHAR szAppName[] = TEXT ("TrackDrawer") ;
     HWND         hwnd ;
     MSG          msg ;
     WNDCLASS     wndclass ;
     
     wndclass.style         = CS_HREDRAW | CS_VREDRAW ;
     wndclass.lpfnWndProc   = WndProc ;
     wndclass.cbClsExtra    = 0 ;
     wndclass.cbWndExtra    = 0 ;
     wndclass.hInstance     = hInstance ;
     wndclass.hIcon         = LoadIcon (NULL, IDI_APPLICATION) ;
     wndclass.hCursor       = LoadCursor (NULL, IDC_ARROW) ;
     wndclass.hbrBackground = (HBRUSH) GetStockObject (WHITE_BRUSH) ;
     wndclass.lpszMenuName  = NULL ;
     wndclass.lpszClassName = szAppName ;
     
     if (!RegisterClass (&wndclass))
     {
          MessageBox (NULL, TEXT ("Memory error!"),
                      szAppName, MB_ICONERROR) ;
          return 0 ;
     }
     
     hwnd = CreateWindow (szAppName, TEXT ("TrackDrawer"),
                          WS_OVERLAPPEDWINDOW,
                          CW_USEDEFAULT, CW_USEDEFAULT,
                          CW_USEDEFAULT, CW_USEDEFAULT,
                          NULL, NULL, hInstance, NULL) ;
     
     ShowWindow (hwnd, iCmdShow) ;
     UpdateWindow (hwnd) ;
     
     while (GetMessage (&msg, NULL, 0, 0))
     {
          TranslateMessage (&msg) ;
          DispatchMessage (&msg) ;
     }
     return msg.wParam ;
}

LRESULT CALLBACK WndProc (HWND hwnd, UINT message, WPARAM wParam, LPARAM lParam)
{
     TCHAR               szBuffer [16] ;   
     HDC                 hdc ;
     PAINTSTRUCT         ps ;
     TEXTMETRIC          tm ;
     
     static int          cxClient, cyClient ;                             // They're necessary to draw a grid in a background
     static int          cxChar, cyChar, cxCaps ;                         // These make possible to draw a suitable rectangle under text informations
                         
     int                 xTextBoxLeft, yTextBoxTop, iStrLenght;           // Variables which define coordinates of rectangle under text information
     int                 i ;                                              // Variables using in loops
           
     switch (message)
     {
         case WM_CREATE:
              hdc = BeginPaint (hwnd, &ps) ;
             
              // Getting info abou font
              GetTextMetrics (hdc, &tm) ;
              cxChar = tm.tmAveCharWidth ;
              cyChar = tm.tmHeight ;
              cxCaps = (tm.tmPitchAndFamily & 1 ? 3 : 2) * cxChar / 2 ;
             
              // Defining start values of some variables
              cWPoints = 0 ;
              iScaleDominator = 1 ;
              iScaleNumerator = 1 ;
             
              EndPaint (hwnd, &ps) ;
              return 0 ;
             
         case WM_PAINT:
              hdc = BeginPaint (hwnd, &ps) ;
             
              // Drawing gray grid in a background with PS_DOT pen
              SelectObject (hdc, CreatePen (PS_DOT, 0, GRID_COLOUR)) ;
              for (i = GRID_DETAIL ; i < cxClient ; i+=GRID_DETAIL)
              {   
                  MoveToEx (hdc, i, 0, NULL) ;
                  LineTo   (hdc, i, cyClient) ;   
              }
              for( i = GRID_DETAIL ; i < cyClient ; i+=GRID_DETAIL)
              {   
                  MoveToEx (hdc, 0, i, NULL) ;
                  LineTo   (hdc, cxClient, i) ;   
              }
             
              // Drawing waypoints
              SelectObject (hdc, CreatePen (PS_SOLID, 2, WAYPOINT_OUTLINE_COLOUR)) ;
              SelectObject (hdc, CreateSolidBrush (WAYPOINT_FILL_COLOUR)) ;
              for (i = 0 ; i < cWPoints ; i++)
                  Ellipse(hdc, xyWayPoints[i].x-5, xyWayPoints[i].y-5, xyWayPoints[i].x+5, xyWayPoints[i].y+5) ;
             
              // Linking waypoints
              SelectObject (hdc, CreatePen (PS_SOLID, 2, LINES_COLOUR)) ;
              Polyline (hdc, xyWayPoints, cWPoints) ;
             
              // Pritnig text information about distances between waypoints
              if (cWPoints > 1)
              {   
                  for (i=0 ; i < cWPoints - 1 ; i++)
                  {
                      iStrLenght = wsprintf (szBuffer, TEXT ("%d cm"), \
                              (int) Diagonal(xyWayPoints[i].x - xyWayPoints[i+1].x, xyWayPoints[i].y - xyWayPoints[i+1].y) / iScaleNumerator * iScaleDominator) ;
                     
                      // Defining position for text information       
                      xTextBoxLeft = ((xyWayPoints[i].x + xyWayPoints[i+1].x) / 2) - (iStrLenght / 2 * cxCaps) ; 
                      yTextBoxTop =  ((xyWayPoints[i].y + xyWayPoints[i+1].y) / 2) - (cyChar / 2);
                     
                      //iStrLenght++ ; 
                      TextOut (hdc, xTextBoxLeft, yTextBoxTop, szBuffer, iStrLenght) ;                                       
                  }
              }
             
              // Printing text info about actual scale
              iStrLenght = wsprintf (szBuffer, TEXT ("%d px - %d cm"), iScaleNumerator, iScaleDominator) ;
              TextOut (hdc, 0, 0, szBuffer, iStrLenght) ;
                         
              EndPaint (hwnd, &ps) ;
              return 0 ;
               
         case WM_SIZE:
              //Getting information about window's size             
              cxClient = LOWORD(lParam) ;
              cyClient = HIWORD(lParam) ;
             
              return 0;
         
         case WM_LBUTTONDOWN:
              if (wParam & MK_LBUTTON)
              {
                  // Save point of mouse button click as a waypoint       
                  if (cWPoints < MEMORY_LIMIT)
                  {           
                      xyWayPoints[cWPoints].x = LOWORD (lParam) ;
                      xyWayPoints[cWPoints].y = HIWORD (lParam) ;
                      cWPoints++ ;
                     
                      InvalidateRect (hwnd, NULL, FALSE) ;     
                  }   
              }         
              return 0 ;
             
         case WM_KEYDOWN: 
              switch (wParam)
              {
                  case VK_F1:     
                     SaveTrack() ;                           
                     break ;
                 
                  case VK_F5:
                       iScaleNumerator++ ;     
                       InvalidateRect (hwnd, NULL, TRUE) ;
                       return ;
                         
                  case VK_F6:
                       if( iScaleNumerator > 1)
                           iScaleNumerator-- ;     
                       InvalidateRect (hwnd, NULL, TRUE) ;
                       return ;
                       
                  case VK_F7:
                       iScaleDominator++ ;     
                       InvalidateRect (hwnd, NULL, TRUE) ;
                       return ;
                         
                  case VK_F8:
                       if( iScaleDominator > 1)
                           iScaleDominator-- ;     
                       InvalidateRect (hwnd, NULL, TRUE) ;
                       return ;
                                             
                  case VK_DELETE:
                       cWPoints = 0 ;
                       InvalidateRect (hwnd, NULL, TRUE) ; 
                       return;
                       
                  case VK_BACK:
                       if(cWPoints > 0) cWPoints-- ;
                           InvalidateRect (hwnd, NULL, TRUE) ;   
                       return;
                                     
                  default: return 0;
              }
              return 0 ;
                         
         case WM_DESTROY:
              PostQuitMessage (0) ;
              return 0 ;
     }
     return DefWindowProc (hwnd, message, wParam, lParam) ;
}
void SaveTrack()
{
    int         i ;                                    // Variables using in loops   
    float       fAngle, fTurnAngle, fATangens, fOrientation, fxTemp, fyTemp, fDistance, AbsDivisionXY ;
   
    // Start direction of spybot is a top of screen (mathematical grid, not geographic)
    fOrientation = 90 ;
                       
    for (i=0 ; i < cWPoints -1; i++)
    {   
         // It's an algorytm which calculate angle of turn which spybot has to do to get in correct direction                 
         fxTemp = -1 * (xyWayPoints[i].x - xyWayPoints[i+1].x) ;        // X distance beetwen start and destination positions, -1 because program works in MM_TEXT mode
         fyTemp = xyWayPoints[i].y - xyWayPoints[i+1].y ;               // Y distance beetwen start and destination positions
         
         AbsDivisionXY = fxTemp/fyTemp ;
         AbsDivisionXY = (AbsDivisionXY > 0 ? AbsDivisionXY : (-1 * AbsDivisionXY)) ;
         
         fATangens = 90 - atan(AbsDivisionXY) * 180 / M_PI ;           // Calculating atan()             
         
         // These fragment define in which quadrant destination point is (point of reference = start point) and calculate absolute angle (0 deg. - right side of the screen)
         if (fxTemp >= 0 && fyTemp >= 0)
             fAngle = fATangens ;
         else if (fxTemp <= 0 && fyTemp >= 0)
             fAngle = 180 - fATangens ;
         else if (fxTemp <= 0 && fyTemp <= 0)
             fAngle = 180 + fATangens ;
         else if (fxTemp >= 0 && fyTemp <= 0)
             fAngle = 360 - fATangens ;
         
         // In these fragment program calculate a turn angle which spybot has to do to turn in correct direction.
         // fOrrientation = angle (in reference to the right of screen) of spybot after previous move
         if (fOrientation > fAngle)
         {
             if (fOrientation - fAngle <= 180)
                 fTurnAngle = fOrientation - fAngle ;
             else
                 fTurnAngle = -1 * (360 - fOrientation + fAngle) ; 
         }
         else if (fOrientation < fAngle)
         {
             if (fAngle - fOrientation <= 180)
                 fTurnAngle = - (fAngle - fOrientation) ;
             else
                 fTurnAngle = 360 - fAngle + fOrientation ; 
         }
         else fTurnAngle = 0 ;
         // End of algorytm
                 
         // For calculating angles in next steps it's necessary to save azimuth as an orientation
         fOrientation = fAngle ;
             
         // Writing to arrays
         Angles[i] = (int) fTurnAngle ;
         Distances[i] = (int) Diagonal(fxTemp, fyTemp) / iScaleNumerator * iScaleDominator ;                           
    }
   
    // Creating header file which is using by spybot's program
    CreateHeader() ; 
   
    return ;   
}

void CreateHeader()
{
     FILE    *fSource ;
     int     i ;
     
     fSource = fopen ("track.nqh", "w") ;
     fprintf (fSource, "int Lines = %d ;\nint AngleTab[%d], DistanceTab[%d] ;\n\nsub initiate ()\n{\n", cWPoints - 1, cWPoints - 1, cWPoints - 1) ;
     
     for (i=0 ; i < cWPoints - 1; i++)
         fprintf (fSource, "\tAngleTab[%d] = %d ;\n\tDistanceTab[%d] = %d ;\n\n", i, Angles[i], i, Distances[i]) ;

     fprintf (fSource, "\treturn ;\n}") ;     
     
     fclose (fSource) ;
     return ;                                                                     
}

float Diagonal (float a, float b)
{
    return sqrt(pow(abs(a),2) + pow(abs(b),2)) ;   
}