osd-contiki/examples/osd/arduino-windsonic/sketch.pde

/*
 * Sample arduino sketch using contiki features.
 * Unfortunately sleeping for long times in loop() isn't currently
 * possible, something turns off the CPU (including PWM outputs) if a
 * Proto-Thread is taking too long. We need to find out how to sleep in
 * a Contiki-compatible way.
 * Note that for a normal arduino sketch you won't have to include any
 * of the contiki-specific files here, the sketch should just work.
 */


extern "C" {
#include <stdio.h>
#include "arduino-process.h"
#include "rest-engine.h"

extern resource_t res_wind, res_wind_speed_max, res_wind_status,
  res_wind_speed, res_wind_direction, res_power_supply;

#define STX 0x02
#define ETX 0x03
#define STRING_TERMINATOR 0x00

#define LED_PIN 4
}

int   state           = 0;
char  ws_status       [32];
int   ws_speed_hi     = 0;
int   ws_speed_lo     = 0;
char  ws_unit         [8];
int   ws_direction    = 0;
int   supply_voltage_hi = 0;
int supply_voltage_lo = 0;
int   ws_max_speed    = 0;
int   ws_max_speed_lo = 0;
int   ws_max_speed_hi = 0;

int wind_speeds [WIND_SPEEDS]; // every 2 seconds we get a value
int wind_speed_idx = 0;

uint32_t idx;

void set_no_data (void)
{
  printf ("set no data\n");
  strcpy (ws_status, "No data from sensor");
  ws_speed_lo = 000;
  ws_speed_hi = 000;
  ws_direction = 000;
  ws_max_speed = 0;
  ws_max_speed_hi = 0;
  ws_max_speed_lo = 0;
  wind_speed_idx = 0;
  strcpy (ws_unit, "");

  for (idx = 0; idx < WIND_SPEEDS; idx++)
    wind_speeds [idx] = 0;

}

void setup (void)
{
    // switch off the led
    pinMode(LED_PIN, OUTPUT);
    digitalWrite(LED_PIN, HIGH);

    state = 0;

    // init coap resourcen
    rest_init_engine ();

#pragma GCC diagnostic ignored "-Wwrite-strings"
    rest_activate_resource (&res_wind, "s/wind");
    rest_activate_resource (&res_wind_speed, "s/wind_speed");
    rest_activate_resource (&res_wind_speed_max, "s/wind_speed_max");
    rest_activate_resource (&res_wind_direction, "s/wind_direction");
    rest_activate_resource (&res_wind_status, "s/wind_status");
    rest_activate_resource (&res_power_supply, "s/power_supply");
#pragma GCC diagnostic pop

    //mcu_sleep_set(128); // Power consumtion 278uA; average over 20 minutes
    Serial1.begin (9600);

    set_no_data ();
}

void loop (void)
{
  static int  d, count, msg_length, state0_counter = 0;
  static unsigned char msg_buffer [128], checksum_buffer [3], checksum;

  printf ("state = %d", state);

  switch (state) {
    case 0 :
      printf ("state0\n");
      state0_counter ++;
      if (state0_counter > 10) {
        set_no_data ();
        state0_counter = 0;
      }
      // wait for stx
      while (Serial1.available () > 0) {
        d = Serial1.read ();
        printf ("%d ", d);
        if (d == STX) {
          state = 1;
          count = 0;
          break;
        }
      }
      if (state == 0)
        break;

    case 1 :
      printf ("state1\n");
      state0_counter = 0;

      // wait for etx and read message
      while (Serial1.available () > 0) {
        d = Serial1.read ();
        printf ("%d ", d);
        if (d == ETX) {
          msg_length = count;
          msg_buffer [count] = STRING_TERMINATOR;
          count = 0;
          checksum = 0;
          state = 2;
          break;
        } else {
          msg_buffer [count] = (unsigned char) d;
          count ++;
          if (count > 127) {
            state = 0;
            break;
          }
        }
      }
      if (state == 1)
        break;

    case 2 :
      printf ("state2\n");
      // read checksum
      while (Serial1.available () > 0) {
        d = Serial1.read ();
        printf ("%d ", d);
        printf (" %d (%d)\n", d, count);
        checksum_buffer [count] = (unsigned char) (d & 0xff);
        count ++;
        if (count == 2) {
          checksum_buffer [count] = STRING_TERMINATOR;
          state = 3;
          break;
        }
      }
      if (state == 2)
        break;

    case 3 :
      unsigned int checksum_rx;
      int cnt;

      printf ("state3\n");
      // calc and compare checksum
      checksum = 0;
      sscanf ((const char*)checksum_buffer, "%2X", &checksum_rx);
      for (cnt = 0; cnt < msg_length; cnt++) {
        checksum ^= msg_buffer [cnt];
      }

      if (checksum_rx != checksum) {
        printf ("checksum mismatch %02x != %02x\n", checksum, checksum_rx);
        state = 0;
        break;
      } else {
        state = 4;
      }

    case 4 :
      // parse message Q,079,000.08,M,00,
      char unit [1];
      int status;

      printf ("state4\n");
      printf ("parse messge: %s\n", msg_buffer);
      sscanf
        ( (const char*) msg_buffer
        , "Q,%3d,%3d.%2d,%c,%2d"
        , &ws_direction
        , &ws_speed_hi
        , &ws_speed_lo
        , unit
        , &status
        );

      switch (unit[0]) {
        case 'M' :
          strcpy (ws_unit, "m/s");
          break;

        case 'N' :
          strcpy (ws_unit, "knots");
          break;

        case 'P' :
          strcpy (ws_unit, "mph");
          break;

        case 'K' :
          strcpy (ws_unit, "km/h");
          break;

        case 'F' :
          strcpy (ws_unit, "fpm");
          break;
      }

      switch (status) {
        case 0x00 :
          strcpy (ws_status, "OK");
          break;

        case 0x01 :
          strcpy (ws_status, "Axis 1 failed");
          break;

        case 0x02 :
          strcpy (ws_status, "Axis 2 failed");
          break;

        case 0x03 :
          strcpy (ws_status, "Axis 1+2 failed");
          break;

        case 0x08 :
          strcpy (ws_status, "NVM error");
          break;

        case 0x09 :
          strcpy (ws_status, "ROM error");
          break;
      }

      wind_speeds [wind_speed_idx] = ws_speed_hi * 100 + ws_speed_lo;
      wind_speed_idx ++;
      if (wind_speed_idx > WIND_SPEEDS)
        wind_speed_idx = 0;

      ws_max_speed = 0;
      for (idx = 0; idx < WIND_SPEEDS; idx++) {
        if (wind_speeds [idx] > ws_max_speed)
          ws_max_speed = wind_speeds [idx];
      }

      ws_max_speed_lo = ws_max_speed % 100;
      ws_max_speed_hi = ws_max_speed / 100;

      printf ("speed: %d.%02d %s, dir: %d, status: %s, max: %d.%02d\n"
              , ws_speed_hi, ws_speed_lo, ws_unit, ws_direction, ws_status
              , ws_max_speed_hi, ws_max_speed_lo);

      state = 0;
      break;
  } /* end switch (state) */

  idx = analogRead (A2);
  idx *= 1000;
  idx /= 565;
  supply_voltage_lo = idx % 100;
  supply_voltage_hi = idx / 100;
} /* end loop */