Advertisement
Siorai

Untitled

Jul 30th, 2016
89
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 0.80 KB | None | 0 0
  1. int CurrentHeading(int GPSheading,int MagHeading,int numPixels) {
  2.    
  3.     // Define total number of degrees
  4.     int degrees = 360;
  5.    
  6.     if( GPSheading > MagHeading ) {
  7.         int heading=GPSheading-MagHeading;  // Subtract GPS Heading from Magnetometer heading
  8.         heading=heading/degrees;    // Divide by 360 to get value to multiply the number of pixels by
  9.         heading=heading*numPixels;   // Multiply by number of pixels
  10.         return heading; // return final heading
  11.     }
  12.    
  13.     else if( GPSheading < MagHeading ) {
  14.         int heading=MagHeading-GPSheading;
  15.         heading=degrees-heading;
  16.         heading=heading/degrees;
  17.         heading=heading*numPixels;   // Multiply by number of pixels
  18.         return heading;  // return final heading
  19.         }
  20.    
  21.     else {
  22.     }
  23. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement