Arduino_Robot/Robot_program.asv at master · Christiaan2/Arduino_Robot · 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
%{
    Name: Christiaan Reurslag
    Studentnummer: s1495089
    Assignment: Arduino part 2 Exercise 9 and 10
    MATLAB R2016b
%}

%Close all figures and clear workspace and command window
clear all
close all
clc

NChannels = 7;

WindowSize = 10000; %Last 10 seconds are visible in figure
colours = {[0, 0.4470, 0.7410], [0.8500, 0.3250, 0.0980], [0.9290, 0.6940, 0.1250], ...
    [0.4940, 0.1840, 0.5560], 	[0.4660, 0.6740, 0.1880], 	[0.3010, 0.7450, 0.9330], ...
    [0.6350, 0.0780, 0.1840], [0.25, 0.25, 0.25]}; %Define the colors of the lines used to plot the data

Arduino=serial('COM4','BaudRate',115200,'TimeOut',inf);
fopen(Arduino); %Initiate arduino communication

%Create figure with labels and grid
figure();
hold on
grid on
grid minor
%ylim([0,5]);%%%
xlabel('Time [ms]')
ylabel('Value [10 bits]')

%Open textfile
fileId = fopen('LogPlotData.txt','w');
fprintf(fileId,'Data recieved from Arduino\r\n');

j = 0;  %Count number of measurements
sampling = true;    %When true, Matlab looks for new data send from the Arduino

while(sampling)
    start_message = fread(Arduino,1,'uint16'); %Read data as integer (1 time 2 bytes (16 bits))
    if(start_message == 65535) %Start sign recieved from Arduino?
        j = j + 1;
        for k = 1:NChannels
            h(k) = animatedline;
            h(k).Color = colours{k}; %Set colour of line
        end

        fprintf(fileId,'\r\nMeasurement number: %u\r\n', j);
        for k = 1:NChannels
            fprintf(fileId,'\tValue%u',k);
        end
        fprintf(fileId,'\r\n');
        i = 0;  %Count number of samples taken
        SensorReading = zeros(1,NChannels,'uint16');
        disp('Start sampling')
        while(true)
            SensorReading(1) = fread(Arduino,1,'uint16');

            switch SensorReading(1)
                case 65279  %Stop measurement
                    disp('Stop sampling')
                    break
                case 65023  %Stop Matlab
                    sampling = false;
                    disp('Stop MATLAB')
                    break
            end

            for k = 2:NChannels
                SensorReading(k) = fread(Arduino,1,'uint16'); %Read data as integer (2 bytes)
            end
            Time = fread(Arduino,1,'uint32');%Read time as unsigned integer (4 bytes)

            %Update texfile
            fprintf(fileId,'%u',Time);
            %Update graph
            for k = 1:NChannels
                addpoints(h(k),Time,double(SensorReading(k)))

                %Update texfile
                fprintf(fileId,'\t%u',SensorReading(k));
            end
            fprintf(fileId,'\r\n');
            i = i + 1;
            xlim([Time-WindowSize,Time])
            drawnow update
        end
    elseif(start_message == 65023)
        sampling = false;
        disp('Stop MATLAB')
    end
end

fclose(Arduino); %End communication with arduino
fclose(fileId);  %Close textfile