FireFuse/calibrate.cpp at master · firepick1/FireFuse · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
#include "FireSight.hpp"
#include <string.h>
#include <errno.h>
#include <fcntl.h>
#include <dirent.h>
#include <stdio.h>
#include <time.h>
#include <iostream>
#include <fstream>
#include <sstream>
#include <unistd.h>
#include "firefuse.h"
#include "version.h"

////////////////////////////// SpiralIterator /////////////////////

SpiralIterator::SpiralIterator(int xSteps, int ySteps) {
  assert(xSteps > 0 && ySteps > 0);
  this->xMax = xSteps/2;
  this->yMax = ySteps ? ySteps/2 : this->xMax;
  this->xScale = 1;
  this->yScale = 1;
  this->xOffset = 0;
  this->yOffset = 0;
  assert(ySteps == 0 || ySteps == 1 || xSteps == 1 || ySteps == xSteps);
  reset();
}

void SpiralIterator::reset() {
  if (yMax == 0) {
    this->x = -xMax;
    this->y = 0;
    this->dx = 1;
    this->dy = 0;
    this->state = 6;
    this->mx = 0;
    this->my = 0;
  } else if (xMax == 0) {
    this->x = 0;
    this->y = -yMax;
    this->dx = 0;
    this->dy = 1;
    this->state = 6;
    this->mx = 0;
    this->my = 0;
  } else {
    this->x = 0;
    this->y = 0;
    this->dx = 1;
    this->dy = 0;
    this->state = 0;
    this->mx = 0;
    this->my = 0;
  }
}

bool SpiralIterator::next() {
  if (x > xMax || y > yMax) { return FALSE; }
  x += dx;
  y += dy;
  switch (state) {
    case 0: state = 1; mx++; my++; dx = 0; dy = 1; break;
    case 1: if (y >= my) { state = 2; dx = -1; dy = 0; } break;
    case 2: if (x <= -mx ) { state = 3; dx = 0; dy = -1; } break;
    case 3: if (y <= -my ) { state = 4; dx = 1; dy = 0; } break;
    case 4: if (mx <= x) { state = 5; dx = 0; dy = 1; } break;
    case 5: if (0 <= y) { state = 1; mx++, my++; x++; } break;
    case 6: break;
    default: assert(FALSE); break;
  }
  // cout << "state:" << state << " mx:"<<mx << " my:"<<my << " dx:"<<dx << " dy:"<<dy << " x:"<<x << " y:"<<y << " xMax:"<<xMax<< endl;

  return x <= xMax && y <= yMax ? TRUE : FALSE;
}

/////////////////////////////////////////////////////////////////////////