-
Notifications
You must be signed in to change notification settings - Fork 2
/
expMDF.m
272 lines (236 loc) · 9 KB
/
expMDF.m
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
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
% Write data to MDA dat file
% inputs:
% 1- Data in table format
% 2 - filename to write to *.dat
%
% usage: expMDF(dataTable, fileoutname)
% Author : Rahul Rajampeta
% Date: April 15, 2016
function expMDF(dataTable, fileoutname)
%% create the fid to write
fid = fopen(fileoutname,'W');
%% pass the table data
varNames = getVariableNames(dataTable);
varUnits = getTableUnits(dataTable);
numChannels = length(varNames);
numSamples = height(dataTable);
rateSample = 0; % required for virtual signal only.
%% Define locations for each block
linkID = 0; % DO NOT CHANGE THIS
linkHD = 64; % DO NOT CHANGE THIS
linkCC = 300;
blocksize_cc = 63; % for linear format of data 63 bytes
padd_cc = 2;
linkCN = linkCC + numChannels*(blocksize_cc+padd_cc);
blocksize_cn = 228; % constant
padd_cn = 2;
linkCG = linkCN + numChannels*(blocksize_cn+padd_cn);
linkDG = linkCG + 50; % 26+padding
linkDT = linkDG + 50; %28 + padding
% NOTE: dump empty characters untill linkDT otherwise fseek wont move to
% desired position to write to
fwrite(fid, repmat(char(0),1,linkDT), 'char');
%% write ID block
writeIDBlock(fid, linkID);
%% write HD block
writeHDBlock(fid, linkHD, linkDG);
%% write DG block - assume only one DG
writeDGBlock(fid, linkDG, linkCG, linkDT);
%% write CG block - assume only one CG
writeCGBlock(fid, linkCG, linkCN, numChannels, numSamples);
%% write CC/CN blocks
for vars = 1 : numChannels
writeCCBlock(fid, linkCC, varUnits{vars});
nextCN = linkCN+blocksize_cn+padd_cn;
writeCNBlock(fid, linkCN, linkCC, nextCN, varNames{vars}, vars, rateSample, vars == numChannels);
linkCC = linkCC+blocksize_cc+padd_cc;
linkCN = linkCN+blocksize_cn+padd_cn;
end
%% and write DTblock
writeDTBlock(fid, linkDT, dataTable);
fclose(fid);
end
%% ID block def
% dont change this
function writeIDBlock(fid, offset)
fseek(fid,offset,'bof');
fwrite(fid,'MDF 3.00 TGT 15.0', 'char');
fwrite(fid,0,'uint16');
fwrite(fid,0,'uint16');
fwrite(fid,300,'uint16');
fwrite(fid,0,'uint16');
fwrite(fid,repmat(char(0),1,28),'char');
fwrite(fid,0,'uint16');
fwrite(fid,0,'uint16');
% ftell(fid)
end
%% HD block def
function writeHDBlock(fid, offset, linkDG)
blocksize = 164;
fseek(fid,offset,'bof'); % file pointer always to 64 for HD
fwrite(fid,char('HD'),'char');
fwrite(fid,blocksize,'uint16');
fwrite(fid,linkDG,'uint32'); % pointer to DG block
fwrite(fid,0,'uint32'); % pointer to TX
fwrite(fid,0,'uint32'); %pointer to PR
fwrite(fid,1,'uint16'); % number of DG BLOCKS (assume only one to write to)
fwrite(fid,datestr(now,'dd:mm:yyyy'),'char'); % datestring
fwrite(fid,datestr(now,'HH:MM:SS'),'char'); % timestring
username = getenv('USERNAME');
fwrite(fid,username(1:min(length(username),31)), 'char'); % author
fseek(fid,32-length(username),0); % fill the rest 32bytes with null
fwrite(fid,repmat(char(' '),1,32),'char'); %organisation name
fwrite(fid,repmat(char(' '),1,32),'char'); % project name
fwrite(fid,repmat(char(' '),1,32),'char'); % vehicle/dyno name
end
%% DG block def
function writeDGBlock(fid, offset, linkCG, linkDT)
%assume only one DG block to write
blocksize = 28;
fseek(fid,offset,'bof');
fwrite(fid,char('DG'),'2*char');
fwrite(fid,blocksize,'uint16'); %block size
fwrite(fid,0,'uint32'); %skip next DG
fwrite(fid,linkCG,'uint32'); % CG link
fwrite(fid,0,'uint32'); % skip trigger block TR
fwrite(fid,linkDT,'uint32'); % Data DR link
fwrite(fid,1,'uint16'); % assume only one CG block
fwrite(fid,0,'uint16'); % assume zero recordIDs
fwrite(fid,0,'uint32'); %reserved
if blocksize ~= (ftell(fid)-offset)
disp(['blocksize error DG']);
end
end
%% CG block def
function writeCGBlock(fid, offset, linkCN, numChannels, numSamples)
%assume only one CG block to write
blocksize = 26;
fseek(fid,offset,'bof');
fwrite(fid,char('CG'),'2*char');
fwrite(fid,blocksize,'uint16'); %block size
fwrite(fid,0,'uint32'); %skip next CG
fwrite(fid,linkCN,'uint32'); %link to CN block
fwrite(fid,0,'uint32'); %skip TX block
fwrite(fid,2,'uint16'); %recordID
fwrite(fid,uint16(numChannels),'uint16'); % number of channels
fwrite(fid,uint16(numChannels*4),'uint16'); % record size (number of channels*(single)=32bits=4bytes)
fwrite(fid,uint32(numSamples),'uint32'); %number of samples
if blocksize ~= (ftell(fid)-offset)
disp(['blocksize error CG']);
end
end
%% CN block def
function writeCNBlock(fid, offset, linkCC, nextLinkCN, signalName, numVar, rateSample, lastVar)
if lastVar
nextLinkCN = 0;
end
blocksize = 228;
% calculate start offset with byte offset
% if start bit is more than 16 bytes, use additional byte offset
start_bit_raw = 32*(numVar-1);
if (start_bit_raw <= 2^16-1)
start_offset = start_bit_raw;
add_byte_offset = 0;
else
start_offset = mod(start_bit_raw, 8);
add_byte_offset = floor(start_bit_raw/8);
end
fseek(fid,offset,'bof');
fwrite(fid,'CN','char');
fwrite(fid,blocksize,'uint16'); %block size
fwrite(fid,nextLinkCN,'uint32'); % link to nextCN
fwrite(fid,linkCC,'uint32'); % link to CC block
fwrite(fid,0,'uint32'); % link to CE block
fwrite(fid,0,'uint32'); % link to CD block
fwrite(fid,0,'uint32'); % link to TX block
if strcmp(signalName,'time')
fwrite(fid,1,'uint16'); %channel type
else
fwrite(fid,0,'uint16');
end
fwrite(fid,signalName(1:min(length(signalName),31)), 'char');
fseek(fid,32-length(signalName),0); % fill the rest 32bytes with null
fwrite(fid,'simulink output data','char');
fseek(fid,128-length('simulink output data'),0); % fill the rest 128bytes with null
fwrite(fid,start_offset,'uint16'); %start offset
fwrite(fid,32,'uint16'); %num of bits
fwrite(fid,2,'uint16'); % single format (4bytes)
fwrite(fid,0,'uint16'); % value range valid
fwrite(fid,0,'double'); % min signal value
fwrite(fid,0,'double'); % max signal value
fwrite(fid,rateSample,'double'); % sampling rate
fwrite(fid,0,'uint32'); %skip TX block
fwrite(fid,0,'uint32'); %skip TX block
fwrite(fid,add_byte_offset,'uint16'); % additional byte offset
end
%% CC block def
function writeCCBlock(fid, offset, units)
% units modification - limit to 20 with trailing zeros
units = units(1:min(19,length(units)));
units = [units repmat(char(0),1,20-length(units))];
blocksize = 62;
fseek(fid,offset,'bof');
fwrite(fid,'CC','char');
fwrite(fid,blocksize,'uint16'); %block size
fwrite(fid,0,'uint16'); % value range valid
fwrite(fid,0,'double'); % min signal value
fwrite(fid,0,'double'); % max signal value
fwrite(fid,units,'char'); % units of the signal
fwrite(fid,0,'uint16'); % conversion type - linear
fwrite(fid,2,'uint16'); % number of parameters
fwrite(fid,0,'double'); % P1
fwrite(fid,1,'double'); % P2
end
%% Data block - write row-wise
function writeDTBlock(fid, offset, dataTable)
fseek(fid,offset,'bof');
% for row = 1:height(dataTable)
% fwrite(fid,dataTable{row,:},'single');
% end
dataTableRow = reshape(dataTable{:,:}', 1, []);
fwrite(fid,dataTableRow, 'single');
end
%% Fix variable names
function varnames = getVariableNames(dataTable)
% variable names should conform to
% 1 - no space allowed : replace with __
% 2 - length should be less than 31 chars
% 3 - unique name for each variables
varnames = dataTable.Properties.VariableNames;
% check if space exists in names
varnames = strrep(varnames, ' ','_');
% check more than 31 chars names
flg_longnames = cellfun(@(x) length(x)>31, varnames, 'UniformOutput', false);
flg_longnames = [flg_longnames{:}]'; % convert cell to logical array
% then truncate in between; use rolling 31 chars that produce unique names
if any(flg_longnames)
newvarnames = varnames;
longnames = varnames(flg_longnames);
shift_idx=[0:1:14 -1:-1:-14];
i=1;
while ((length(unique(newvarnames)) ~= length(newvarnames) || i==1) && i<= length(shift_idx))
idx = shift_idx(i);
newlongnames = cellfun(@(x) [x(1:15-idx) '_' x(end-14-idx:end)], longnames, 'UniformOutput', false);
newvarnames(flg_longnames) = newlongnames;
i=i+1;
end
if (length(unique(newvarnames)) ~= length(newvarnames) && i > length(shift_idx))
error('Try to minimize the signal names to less than 31 chars');
else
varnames = newvarnames;
end
end
% convert ls/rs to brackets
varnames = strrep(varnames, '_ls_','[');
varnames = strrep(varnames, '_rs_',']');
end
%% DataTable units
function units = getTableUnits(dataTable)
units = dataTable.Properties.VariableUnits;
% if no units are set to either of the column
if isempty(units)
% set empty units to first column, it forces empty units to all columns
dataTable.Properties.VariableUnits{1} = '';
units = dataTable.Properties.VariableUnits;
end
end