Onderwerp: Navmonpc hdg info

#include <Wire.h>
#include <LSM303.h>
LSM303 compass;

void setup() {
  //pinMode(txPin, OUTPUT);
  Serial.begin(4800);
  Wire.begin();
  compass.init();
  compass.enableDefault();

  // Calibration values. Use the Calibrate example program to get the values for
  // your compass.
  compass.m_min.x = 2047;  
  compass.m_min.y = 990;  
  compass.m_min.z = 280;
  compass.m_max.x = -360;  
  compass.m_max.y = -832;  
  compass.m_max.z = -2175;  
}

/* Oorspronkelijke code
 void loop() {
 compass.read();
 int heading = compass.heading((LSM303::vector){0,-1,0});
 Serial.println(heading);
 delay(500);
 } 
 */

/*----------------------------------------------------------------------------
 1   2   3 4   5 6
 |   |   | |   | |
 $--HDG,x.x,x.x,a,x.x,a*hh<CR><LF>
 ------------------------------------------------------------------------------
 
 Field Number: 
 1. Magnetic Sensor heading in degrees
 2. Magnetic Deviation, degrees
 3. Magnetic Deviation direction, E = Easterly, W = Westerly
 4. Magnetic Variation degrees
 5. Magnetic Variation direction, E = Easterly, W = Westerly
 6. Checksum */

char nmeastr[17]; // HCHDG,000.00,,,,*
int checksum;
char hs[6]; // 000.00

void loop() {

  strcpy(nmeastr,"HCHDG,");
  compass.read();

  int heading = compass.heading((LSM303::vector){0,-1,0  }); //1,0,0 will allign North with SFE silkscreen

  dtostrf(heading, 5, 2, hs);
  
  strcat(nmeastr,hs);
  strcat(nmeastr,",,,,");

  //add a checksum
  checksum=0;
  for (int n=0; n < strlen(nmeastr); n++) {
    checksum ^= nmeastr[n];
  }

  Serial.print("$");
  Serial.print(nmeastr);
  Serial.print("*");
  Serial.print(checksum, HEX);
  Serial.println();

  /* 5hz == 200 */
  delay(200);
}