firmware/Scanner.cpp at master · OpenAFM/firmware · 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
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
// Author A Michel
// Date 20 08 15
// Lego2Nano 2015

#include"Scanner.h"
#include"RTx.h"

// Constructor
Scanner::Scanner(const DACController &controller, const SignalSampler &sampler, const RTx &phone, constint lineLength) : pixels(newint[lineLength * 2]), controller(controller), sampler(sampler), phone(phone) {
this->startTime = 0;
this->endTime = 0;
this->scanning = false;
this->lineLength = lineLength;
}

// Destructor
Scanner::~Scanner() {
delete[] pixels;
}

// reset. Stop the scanning process and resets all parameters.
voidScanner::reset()
{
stop();
// TODO implement proper interruption of process.
delay(5000);

	controller.reset();
	sampler.reset();
	startTime = 0;
	endTime = 0;
	linesScanned = 0;
}

// Scans one line and stores data in the pixel array.
// Does a trace and retrace. The retrace data will be in backward order.
intScanner::scanLine() {
unsignedint x = 0;

//trace
for (int i = 0; i < controller.getLineSize(); i++) {
 pixels[x] = sampler.detectPixel();
 x++;
if (i + 1 < controller.getLineSize())
 controller.increaseVoltage();
	}

//retrace
for (int i = 0; i < controller.getLineSize(); i++) {
 pixels[x] = sampler.detectPixel();
 x++;
if(i + 1 < controller.getLineSize())
 controller.decreaseVoltage();
	}

	linesScanned++;

return0;
}

// Start the scanning process.
intScanner::start() {

// get start time
	startTime = millis();
	scanning = true;

// interates over y-axis calling ctrl.nextLine()
for (int i = 0; i < lineLength; i++) {

// scans one line (trace & re-trace)
scanLine();

 scanning = phone.sendData(pixels, 2 * lineLength);

// next line on y-axis
unsignedint cl = controller.nextLine();

if (scanning == false) {
break;
 }
	}
stop();
}

intScanner::stream() {
 startTime = millis();
int data[1];
bool streaming = 1;
while (true){
 data[0] = sampler.detectPixel();
 streaming = phone.sendData(data, 1);
if (streaming == false)
break;
 }
stop();
}

// stop the scanning process and resets the parameters.
intScanner::stop() {

// calculate lapsed time
	endTime = millis() - startTime;
	scanning = false;
}

// return the lapsed time
unsignedlongScanner::getLapsedTime() {
return endTime;
}


extern String constPARAM_LINE_LENGTH = "LINELENGTH";

voidScanner::setParam(String param, String value) {
stop();

if (PARAM_LINE_LENGTH == param) {
 lineLength = atoi(value.c_str());
	}

}

voidScanner::invertChannels() {
	controller.invert();
}