//////////////////////////////////////////////////////////////////////////
// AddHeading
//
// Takes a compass heading from 0 to 359 and an angle from -359 to 359.
// Adds the angle to the compass heading and returns a new heading
// from 0 to 359.
//
// ToDo: Add error checking for the heading out of range < 0 or > 359.
// ToDo: Add error checking for the angle out of range < -359 or > 359.
//       Or modulo the angle with 360.
//////////////////////////////////////////////////////////////////////////
int addheading(int startHeading, int changeAngle)
{
   int targetHeading = startHeading + changeAngle;

   if (targetHeading < 0)
       targetHeading += 360;
   else if (targetHeading >= 360)
       targetHeading -= 360;

   return targetHeading;
}

int headingAtStartOfMatch;   // Compass heading we were facing at the start of the match

task main()
{
    headingAtStartOfMatch = sensor[compassSensor];

    // rest of your code goes here.

}