wind.cpp

Go to the documentation of this file.

#include <stdio.h>
#include <math.h>
#include <stdlib.h>

#define DEBUG(msg) \
  fprintf(stderr, "%s\n", msg);

#include "wind.h"


FNode::FNode(unsigned char xx, unsigned char yy) : SNode(xx, yy) {
  

SNode::SNode(unsigned char xx, unsigned char yy) {
  x = xx;
  y = yy;
  stage = LONELY;
  north = south = west = east = northwest = northeast = NULL; 
    southwest = southeast = NULL;
  speed = 0.0f;
  heading = 0.0f;
  last_h = -1;
}

void SNode::set_neighbour(char dir, SNode* other) {
  switch(dir) {
    case NORTH:
      north = other;
      break;
    case SOUTH:
      south = other;
      break;
    case EAST:
      east = other;
      break;
    case WEST:
      west = other;
      break;
    case NORTHEAST:
      northeast = other;
      break;
    case NORTHWEST:
      northwest = other;
      break;
    case SOUTHWEST:
      southwest = other;
      break;
    case SOUTHEAST:
      southeast = other;
      break;
  }
}

void SNode::gen_random() {
  float h;

  // nearly gaussian distribution (always positive)
  h = sqrt(-log(drand48()*MAX_WIND_SPEED));
  h *= (cos(drand48() * 2 * M_PI) + 1);
  speed = h;
  
  // and an even distribution
  do {
    h = (360.0f*rand()/(RAND_MAX+1.0));
  }
  while (is_forbidden(h));
  heading = h;
  stage = READY;
}
  

bool SNode::is_forbidden(float angle) {
  for (int i=0; i<last_h; i++) {
    if (fabs(forbidden_headings[i] - angle) <= 2 * WIND_CONE_DELTA)
      return 1;
  }
  return 0;
}

void SNode::update_forbidden() {
  last_h = -1;
  float tmp;
  if (north != NULL) {
    if (*north->get_stage() >= EMPTY) {
      tmp = *north->get_wind_heading();
      if ((tmp >= 175.0f) && (tmp <= 185.0f)) {
        tmp -= 180.0f;
        forbidden_headings[++last_h] = tmp;
      }
    }
  }
  if (south != NULL) {
    if (*south->get_stage() >= EMPTY) {
      tmp = *south->get_wind_heading();
      if ((tmp >= 355.0f) && (tmp <= 5.0f)) {
        tmp -= 180.0f;
        forbidden_headings[++last_h] = tmp;
      }
    }
  }
  if (west != NULL) {
    if (*west->get_stage() >= EMPTY) {
      tmp = *west->get_wind_heading();
      if ((tmp >= 85.0f) && (tmp <= 95.0f)) {
        tmp -= 180.0f;
        forbidden_headings[++last_h] = tmp;
      }
    }
  }
  if (east != NULL) {
    if (*east->get_stage() >= EMPTY) {
      tmp = *east->get_wind_heading();
      if ((tmp >= 265.0f) && (tmp <= 275.0f)) {
        tmp -= 180.0f;
        forbidden_headings[++last_h] = tmp;
      }
    }
  }
}


SNet::SNet() {
  DEBUG("overall wind network started");
  clg();
  chg();
  initial_rn();
}

void SNet::clg() {
  int i,j;
  SNode* tmp;
  for (i=0; i<NET_HEIGHT; i+=2) {
    for (j=0; j<NET_WIDTH; j+=2) {
      sectors[i][j] = new SNode((unsigned char) j, (unsigned char)i);
     // printf("node %i %i: %p\n", i, j, sectors[i][j]);
    }
  }
  for (i=0; i<NET_HEIGHT; i+=2) {
    for (j=0; j<NET_WIDTH; j+=2) {
      //printf("node %i %i ", i, j);
      if (i == 0)
        tmp = NULL;
      else
        tmp = sectors[i-2][j];
      //printf("north: %p ", tmp);
      sectors[i][j]->set_neighbour(NORTH, tmp);
      if (i == NET_HEIGHT - 1)
        tmp = NULL;
      else
        tmp = sectors[i+2][j];
      //printf("south: %p ", tmp);
      sectors[i][j]->set_neighbour(SOUTH, tmp);
      if (j == 0)
        tmp = NULL;
      else
        tmp = sectors[i][j-2];
      //printf("west: %p ", tmp);
      sectors[i][j]->set_neighbour(WEST, tmp);
      if (j == NET_WIDTH - 1)
        tmp = NULL;
      else
        tmp = sectors[i][j+2];
      //printf("east: %p \n", tmp);
      sectors[i][j]->set_neighbour(EAST, tmp);
      if (i == 0 || j == 0)
        tmp = NULL;
      else 
        tmp = sectors[i-2][j-2];
      //printf("north: %p ", tmp);
      sectors[i][j]->set_neighbour(NORTHWEST, tmp);
      if (i == NET_HEIGHT - 1 || j == 0)
        tmp = NULL;
      else
        tmp = sectors[i+2][j-2];
      //printf("south: %p ", tmp);
      sectors[i][j]->set_neighbour(SOUTHWEST, tmp);
      if (i == 0 || j == NET_WIDTH - 1 )
        tmp = NULL;
      else
        tmp = sectors[i-2][j+2];
      //printf("west: %p ", tmp);
      sectors[i][j]->set_neighbour(NORTHEAST, tmp);
      if (i == NET_HEIGHT -1 || j == NET_WIDTH - 1)
        tmp = NULL;
      else
        tmp = sectors[i+2][j+2];
      sectors[i][j]->set_neighbour(SOUTHEAST, tmp);
      sectors[i][j]->set_empty();
    }
  }
}

void SNet::chg() {
  for (i=0; i<NET_HEIGHT; i++) {
    if (i % 2 == 0)
      next;
    for (j=0; j<NET_WIDTH; j++) {
      if (j % 2 == 0)
        next;
      sectors[i][j] = new FNode((unsigned char)j, (unsigned char) i);
    }
  }
}

void SNet::initial_rn() {
  int i,j;
  for (i=0; i<NET_HEIGHT; i+=2) {
    for (j=0; j<NET_WIDTH; j+=2) {
      if (!(j==i==0)) 
        sectors[i][j]->update_forbidden();
      sectors[i][j]->gen_random();
    }
  }
}

SNet::~SNet() {
  int i,j;
  for (i=0; i<NET_HEIGHT; i++) {
    for (j=0; j<NET_WIDTH; j++) {
      if (sectors[i][j] != NULL)
        delete sectors[i][j];
    }
  }
}

---