summaryrefslogtreecommitdiffstats
path: root/Kod/bilbana/yc4/display/get_response.m
blob: aab66a647139d571411fdc46eaccc64b346b9682 (plain) (blame)
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
function [ack, start_code, responses] = get_response(display_data)
% GET RESPONSE
%	In-depth explanation
%	[flag, display_data] = matlabclient(2)

ack = false;
start_code = '';
responses = [];

if isempty(display_data)
    return
end
bcc = display_data(length(display_data));


pointer = 1;

if display_data(pointer) == 6
	ack = true;
else
	return
end

if pointer > length(display_data)
    return 
end

pointer = pointer + 1;
if display_data(1) == 17
	start_code = 'DC1';
elseif display_data(1) == 18
	start_code = 'DC2';
end

pointer = pointer + 1;
% total length

data = struct;
while pointer < length(display_data) - 1  % (last value is bcc)
    pointer = pointer + 1;
    if display_data(pointer) ~= 27
        % TODO: no ESC?
    end
    pointer = pointer + 1;
    data.id = char(display_data(pointer));
    
    pointer = pointer + 1;
    data.length = display_data(pointer);
    if data.id == 'A'
        pointer = pointer + 1;
        data.data = display_data(pointer);
    else
        pointer = pointer + data.length;
    end
    responses = [responses, data];
end