Decodificare Nmea 0183 ecoscandaglio

International Italiano Software
4

Ma leggi e scrivi sulla stessa seriale?
Dovresti aggiungerne un'altra con SoftwareSerial.
Nel caso tu abbia l'Arduino Mega, ti ricordo che ha 4 seriali hardware.

Prova così.

#include <SoftwareSerial.h>
#include <string.h>
#include <stdio.h>
#include <avr\io.h>
#include <avr\interrupt.h>
#include <Wire.h>

#define DIM 20
#define DIM2 80
#define DIM3 15
#define ECOTX 7
#define ECORX 8

SoftwareSerial EcoSerial(ECORX, ECOTX); // RX, TX

struct tokens {
  byte char_index;
  char array[DIM2];
  char *token[DIM3];
}  
Sonar_tokens;

float Depth, Temp;

void setup()
{
  delay(2000);
  Serial.begin(9600); // Serial Monitor
  Serial.println("Arduino Start!");
  EcoSerial.begin(4800);
}

void loop() {
  read_Sonar();
}

void read_Sonar() {
  while (EcoSerial.available()>0) {
    if (read_tokens(EcoSerial.read(), &Sonar_tokens)) {
      if (!strcmp(Sonar_tokens.token[1],"$SDDPT")) Depth = atof(Sonar_tokens.token[2]); 
      Serial.println((int)(Depth*100));
      if (!strcmp(Sonar_tokens.token[1],"$SDMTW")) Temp = atof(Sonar_tokens.token[2]); 
      Serial.println((int)(Temp*100));
    }
  }
}

int read_tokens (char character, struct tokens *buffer) {
  char i, *p, *token;
  if (character == '\r') {
    buffer->array[buffer->char_index] = 0;
    buffer->char_index = 0;
    if (!checksum(buffer->array)) return 0;
    p = buffer->array;
    i = 0;
    while (token = strtok_r(p, ",", &p)) buffer->token[++i] = token;
    return i;
  }
  if (character == '\n') {
    buffer->char_index = 0;
    return 0;
  }
  buffer->array[buffer->char_index] = character;
  if (buffer->char_index < DIM2) (buffer->char_index)++;
  return 0;
}

int checksum(char *str) {
  int j, len, xor1, xor2;
  len = strlen(str);
  if (str[0] != '

Collega l'ECO ai PIN 7 e 8, oppure ridefiniscili nel #define.) return 0;
  if (str[len-3] != '') return 0;
  xor1 = 16hex2int(str[len-2]) + hex2int(str[len-1]);
  xor2 = 0;
  for (j=1;j<len-3;j++) xor2 = xor2 ^ str[j];
  if (xor1 != xor2) return 0;
  return 1;
}

int hex2int(char a) {
  if (a>='A' && a<='F') return 10+(a-'A');
  if (a>='a' && a<='f') return 10+(a-'a');
  if (a>='0' && a<='9') return a-'0';
  return 0;
}


Collega l'ECO ai PIN 7 e 8, oppure ridefiniscili nel #define.