-
Notifications
You must be signed in to change notification settings - Fork 75
/
dataRead.pyx
1011 lines (977 loc) · 48.4 KB
/
dataRead.pyx
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
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
716
717
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755
756
757
758
759
760
761
762
763
764
765
766
767
768
769
770
771
772
773
774
775
776
777
778
779
780
781
782
783
784
785
786
787
788
789
790
791
792
793
794
795
796
797
798
799
800
801
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818
819
820
821
822
823
824
825
826
827
828
829
830
831
832
833
834
835
836
837
838
839
840
841
842
843
844
845
846
847
848
849
850
851
852
853
854
855
856
857
858
859
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874
875
876
877
878
879
880
881
882
883
884
885
886
887
888
889
890
891
892
893
894
895
896
897
898
899
900
901
902
903
904
905
906
907
908
909
910
911
912
913
914
915
916
917
918
919
920
921
922
923
924
925
926
927
928
929
930
931
932
933
934
935
936
937
938
939
940
941
942
943
944
945
946
947
948
949
950
951
952
953
954
955
956
957
958
959
960
961
962
963
964
965
966
967
968
969
970
971
972
973
974
975
976
977
978
979
980
981
982
983
984
985
986
987
988
989
990
991
992
993
994
995
996
997
998
999
1000
# cython: language_level=3, boundscheck=False
import numpy as np
cimport numpy as np
from sys import byteorder
from libc.stdint cimport uint16_t, uint32_t, uint64_t
from libc.stdio cimport printf
from cpython.mem cimport PyMem_Malloc, PyMem_Free
from cpython.bytes cimport PyBytes_AsString
from libc.string cimport memcpy
cimport cython
@cython.boundscheck(False)
@cython.wraparound(False)
def sorted_data_read(bytes tmp, unsigned short bit_count,
unsigned short signal_data_type, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned char bit_offset,
unsigned long pos_byte_beg, unsigned long n_bytes, array):
"""dataRead function to read in cython a channel from a byte stream
Parameters
------------
tmp : bytes
byte stream
bit_count : unsigned short
number of bit taken by the channel in the record
signal_data_type : unsigned short
int to describe data type
record_format : string
basic numpy dtype description of data type, used to create
returned numpy ndarray
number_of_records : unsigned long long
number of records in byte stream
record_byte_size : unsigned long
number of bytes taken by one record repeated in byte stream
bit_offset : unsigned char
bit offset of data in C aligned bytes
pos_byte_beg : unsigned long
beginning byte position of channel in record
n_bytes : unsigned long
bytes length of channel in record
array : boolean
reads an array, not a vector
Returns
-------
ndarray of type record_format with number_of_records records.
Byte order is swapped if necessary to match machine byte order before bits offset and masking
"""
cdef char* bit_stream = PyBytes_AsString(tmp)
if not array:
if 'V' in record_format or 'S' in record_format or record_format is None:
return read_byte(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, n_bytes, bit_count, bit_offset)
elif signal_data_type in (4, 5) and n_bytes == 4: # float
if (byteorder == 'little' and signal_data_type == 4) or \
(byteorder == 'big' and signal_data_type == 5):
return read_float(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, 0)
else: # swap bytes
return read_float(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, 1)
elif signal_data_type in (4, 5) and n_bytes == 8: # double
if (byteorder == 'little' and signal_data_type == 4) or \
(byteorder == 'big' and signal_data_type == 5):
return read_double(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, 0)
else: # swap bytes
return read_double(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, 1)
elif signal_data_type in (4, 5) and n_bytes == 2: # half precision
if (byteorder == 'little' and signal_data_type == 4) or \
(byteorder == 'big' and signal_data_type == 5):
return read_half(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, 0)
else: # swap bytes
return read_half(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, 1)
elif signal_data_type in (0, 1, 13) and n_bytes == 1: # unsigned char
return read_unsigned_char(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset)
elif signal_data_type in (2, 3) and n_bytes == 1: # signed char
return read_signed_char(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset)
elif signal_data_type in (0, 1, 13, 14) and n_bytes <= 2: # unsigned short
if (byteorder == 'little' and signal_data_type == 0) or \
(byteorder == 'big' and signal_data_type == 1):
return read_unsigned_short(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset, 0)
else: # swap bytes
return read_unsigned_short(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset, 1)
elif signal_data_type in (2, 3) and n_bytes <= 2: # signed short
if (byteorder == 'little' and signal_data_type == 2) or \
(byteorder == 'big' and signal_data_type == 3):
return read_signed_short(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset, 0)
else: # swap bytes
return read_signed_short(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset, 1)
elif signal_data_type in (0, 1, 14) and n_bytes <= 4: # unsigned int
if (byteorder == 'little' and signal_data_type == 0) or \
(byteorder == 'big' and signal_data_type == 1):
return read_unsigned_int(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset, n_bytes, 0)
else: # swap bytes
return read_unsigned_int(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset, n_bytes, 1)
elif signal_data_type in (2, 3) and n_bytes <= 4: # signed int
if (byteorder == 'little' and signal_data_type == 2) or \
(byteorder == 'big' and signal_data_type == 3):
return read_signed_int(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset, n_bytes, 0)
else: # swap bytes
return read_signed_int(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset, n_bytes, 1)
elif signal_data_type in (0, 1) and n_bytes <= 8: # unsigned long long
if (byteorder == 'little' and signal_data_type == 0) or \
(byteorder == 'big' and signal_data_type == 1):
return read_unsigned_longlong(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset, n_bytes, 0)
else: # swap bytes
return read_unsigned_longlong(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset, n_bytes, 1)
elif signal_data_type in (2, 3) and n_bytes <= 8: # signed long long
if (byteorder == 'little' and signal_data_type == 2) or \
(byteorder == 'big' and signal_data_type == 3):
return read_signed_longlong(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset, n_bytes, 0)
else: # swap bytes
return read_signed_longlong(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, bit_count, bit_offset, n_bytes, 1)
elif signal_data_type in (15, 16): # complex
if (byteorder == 'little' and signal_data_type == 0) or \
(byteorder == 'big' and signal_data_type == 1):
swap_flag = 0
else: # swap bytes
swap_flag = 1
if n_bytes == 16:
return read_cdouble(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, 0)
elif n_bytes == 8:
return read_cfloat(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, 0)
elif n_bytes == 4:
return read_chalf(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, 0)
else:
return read_byte(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, n_bytes, bit_count, bit_offset)
else: # array
if (byteorder == 'little' and signal_data_type in (0, 2, 4)) or \
(byteorder == 'big' and signal_data_type in (1, 3, 5)):
return read_array(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, n_bytes, bit_count, bit_offset, 0)
else: # swap bytes
return read_array(bit_stream, record_format, number_of_records,
record_byte_size, pos_byte_beg, n_bytes, bit_count, bit_offset, 1)
cdef inline read_half(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg, unsigned char swap):
cdef uint16_t[:] buf = np.empty(number_of_records, dtype=np.uint16)
cdef unsigned long long i
cdef uint16_t temp_uint16 = 0 # using uint16 because float16_t is not existing
for i in range(number_of_records):
memcpy(&temp_uint16, &bit_stream[pos_byte_beg + record_byte_size * i], 2)
buf[i] = temp_uint16
if swap == 0:
return np.asarray(buf).view(dtype=np.float16)
else:
return np.asarray(buf).view(dtype=np.float16).byteswap()
cdef inline read_chalf(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg, unsigned char swap):
cdef uint64_t[:] buf = np.empty(number_of_records, dtype=np.uint32) # complex_32 does not exist in numpy
cdef unsigned long long i
cdef uint16_t temp16_real = 0
cdef uint16_t temp16_img = 0
for i in range(number_of_records):
memcpy(&temp16_real, &bit_stream[pos_byte_beg + record_byte_size * i], 2)
memcpy(&temp16_img, &bit_stream[pos_byte_beg + record_byte_size * i], 2)
buf[i] = <uint32_t>temp16_real<<32 | <uint32_t>temp16_img
if swap == 0:
return np.asarray(buf).view(dtype=np.complex_64) # returning single instead of half precision complex
else:
return np.asarray(buf).view(dtype=np.complex_64).byteswap()
cdef inline read_float(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg, unsigned char swap):
cdef np.ndarray[np.float32_t] buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef float temp_float = 0
for i in range(number_of_records):
memcpy(&temp_float, &bit_stream[pos_byte_beg + record_byte_size * i], 4)
buf[i] = temp_float
if swap == 0:
return buf
else:
return buf.byteswap()
cdef inline read_cfloat(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg, unsigned char swap):
cdef np.ndarray[np.complex64_t] buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef float complex temp_cfloat = 0
for i in range(number_of_records):
memcpy(&temp_cfloat, &bit_stream[pos_byte_beg + record_byte_size * i], 8)
buf[i] = temp_cfloat
if swap == 0:
return buf
else:
return buf.byteswap()
cdef inline read_double(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg, unsigned char swap):
cdef np.ndarray[np.float64_t] buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef double temp_double = 0
for i in range(number_of_records):
memcpy(&temp_double, &bit_stream[pos_byte_beg + record_byte_size * i], 8)
buf[i] = temp_double
if swap == 0:
return buf
else:
return buf.byteswap()
cdef inline read_cdouble(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg, unsigned char swap):
cdef np.ndarray[np.complex128_t] buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef double complex temp_cdouble = 0
for i in range(number_of_records):
memcpy(&temp_cdouble, &bit_stream[pos_byte_beg + record_byte_size * i], 16)
buf[i] = temp_cdouble
if swap == 0:
return buf
else:
return buf.byteswap()
cdef inline read_unsigned_char(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg,
unsigned long bit_count, unsigned char bit_offset):
cdef np.ndarray[np.uint8_t] buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef unsigned char mask = ((1 << bit_count) - 1)
cdef unsigned char temp1byte = 0
if bit_count == 8:
for i in range(number_of_records):
memcpy(&temp1byte, &bit_stream[pos_byte_beg + record_byte_size * i], 1)
buf[i] = temp1byte
else:
for i in range(number_of_records):
memcpy(&temp1byte, &bit_stream[pos_byte_beg + record_byte_size * i], 1)
# right shift
if bit_offset > 0:
temp1byte = temp1byte >> bit_offset
# mask left part
temp1byte &= mask
buf[i] = temp1byte
return buf
cdef inline read_signed_char(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg,
unsigned long bit_count, unsigned char bit_offset):
cdef np.ndarray[np.int8_t] buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef unsigned char mask = ((1 << bit_count) - 1)
cdef char temp1byte = 0
cdef unsigned char sign_bit = 0
cdef unsigned char sign_bit_mask = (1 << (bit_count-1))
cdef unsigned char sign_extend = ((1 << (8 - bit_count)) - 1) << bit_count
if bit_count == 8:
for i in range(number_of_records):
memcpy(&temp1byte, &bit_stream[pos_byte_beg + record_byte_size * i], 1)
buf[i] = temp1byte
else:
for i in range(number_of_records):
memcpy(&temp1byte, &bit_stream[pos_byte_beg + record_byte_size * i], 1)
# right shift
if bit_offset > 0:
temp1byte = temp1byte >> bit_offset
# mask left part
temp1byte &= mask
sign_bit = temp1byte & sign_bit_mask
if sign_bit: # negative value, sign extend
temp1byte |= sign_extend
buf[i] = temp1byte
return buf
cdef inline read_unsigned_short(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg,
unsigned long bit_count, unsigned char bit_offset, unsigned char swap):
cdef np.ndarray[np.uint16_t] buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef unsigned short mask = ((1 << bit_count) - 1)
cdef unsigned short temp2byte = 0
cdef unsigned char temp[2]
if bit_count == 16:
for i in range(number_of_records):
memcpy(&temp2byte, &bit_stream[pos_byte_beg + record_byte_size * i], 2)
buf[i] = temp2byte
if swap == 0:
return buf
else:
return buf.byteswap()
else:
if swap == 0:
for i in range(number_of_records):
memcpy(&temp2byte, &bit_stream[pos_byte_beg + record_byte_size * i], 2)
# right shift
if bit_offset > 0:
temp2byte = temp2byte >> bit_offset
# mask left part
if bit_count < 16:
temp2byte &= mask
buf[i] = temp2byte
else:
for i in range(number_of_records):
memcpy(&temp, &bit_stream[pos_byte_beg + record_byte_size * i], 2)
temp2byte = temp[0]<<8 | temp[1] # swap bytes
# right shift
if bit_offset > 0:
temp2byte = temp2byte >> bit_offset
# mask left part
if bit_count < 16:
temp2byte &= mask
buf[i] = temp2byte
return buf
cdef inline read_signed_short(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg,
unsigned long bit_count, unsigned char bit_offset, unsigned char swap):
cdef np.ndarray[np.int16_t] buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef unsigned short mask = ((1 << bit_count) - 1)
cdef short temp2byte = 0
cdef unsigned short sign_bit = 0
cdef unsigned short sign_bit_mask = (1 << (bit_count-1))
cdef unsigned short sign_extend = ((1 << (16 - bit_count)) - 1) << bit_count
cdef unsigned char temp[2]
if bit_count == 16:
for i in range(number_of_records):
memcpy(&temp2byte, &bit_stream[pos_byte_beg + record_byte_size * i], 2)
buf[i] = temp2byte
if swap == 0:
return buf
else:
return buf.byteswap()
else:
if swap == 0:
for i in range(number_of_records):
memcpy(&temp2byte, &bit_stream[pos_byte_beg + record_byte_size * i], 2)
# right shift
if bit_offset > 0:
temp2byte = temp2byte >> bit_offset
# mask left part
temp2byte &= mask
sign_bit = temp2byte & sign_bit_mask
if sign_bit: # negative value, sign extend
temp2byte |= sign_extend
buf[i] = temp2byte
else:
for i in range(number_of_records):
memcpy(&temp, &bit_stream[pos_byte_beg + record_byte_size * i], 2)
temp2byte = temp[0]<<8 | temp[1] # swap bytes
# right shift
if bit_offset > 0:
temp2byte = temp2byte >> bit_offset
# mask left part
temp2byte &= mask
sign_bit = temp2byte & sign_bit_mask
if sign_bit: # negative value, sign extend
temp2byte |= sign_extend
buf[i] = temp2byte
return buf
cdef inline read_unsigned_int(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg,
unsigned long bit_count, unsigned char bit_offset, unsigned long n_bytes, unsigned char swap):
cdef np.ndarray[np.uint32_t] buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef unsigned int mask = ((1 << bit_count) - 1)
cdef unsigned int temp4byte = 0
cdef unsigned char temp4[4]
cdef unsigned char temp3[3]
if bit_count == 32:
for i in range(number_of_records):
memcpy(&temp4byte, &bit_stream[pos_byte_beg + record_byte_size * i], 4)
buf[i] = temp4byte
if swap == 0:
return buf
else:
return buf.byteswap()
elif n_bytes == 4:
if swap == 0:
for i in range(number_of_records):
memcpy(&temp4byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
# right shift
if bit_offset > 0:
temp4byte = temp4byte >> bit_offset
# mask left part
if bit_count < 32:
temp4byte &= mask
buf[i] = temp4byte
else:
for i in range(number_of_records):
memcpy(&temp4, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
temp4byte = temp4[0]<<24 | temp4[1]<<16 | temp4[2]<<8 | temp4[3] # swap bytes
# right shift
if bit_offset > 0:
temp4byte = temp4byte >> bit_offset
# mask left part
if bit_count < 32:
temp4byte &= mask
buf[i] = temp4byte
return buf
else: # on 3 bytes
if swap == 0:
for i in range(number_of_records):
memcpy(&temp4byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
# right shift
if bit_offset > 0:
temp4byte = temp4byte >> bit_offset
# mask left part
if bit_count < 24:
temp4byte &= mask
buf[i] = temp4byte
else:
for i in range(number_of_records):
memcpy(&temp3, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
temp4byte = temp3[0]<<16 | temp3[1]<<8 | temp3[2] # swap bytes
# right shift
if bit_offset > 0:
temp4byte = temp4byte >> bit_offset
# mask left part
if bit_count < 24:
temp4byte &= mask
buf[i] = temp4byte
return buf
cdef inline read_signed_int(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg,
unsigned long bit_count, unsigned char bit_offset, unsigned long n_bytes, unsigned char swap):
cdef np.ndarray[np.int32_t] buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef unsigned int mask = ((1 << bit_count) - 1)
cdef int temp4byte = 0
cdef unsigned int sign_bit = 0
cdef unsigned int sign_bit_mask = (1 << (bit_count-1))
cdef unsigned int sign_extend = ((1 << (32 - bit_count)) - 1) << bit_count
cdef unsigned char temp4[4]
cdef unsigned char temp3[3]
if bit_count == 32:
for i in range(number_of_records):
memcpy(&temp4byte, &bit_stream[pos_byte_beg + record_byte_size * i], 4)
buf[i] = temp4byte
if swap == 0:
return buf
else:
return buf.byteswap()
elif n_bytes == 4:
if swap == 0:
for i in range(number_of_records):
memcpy(&temp4byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
# right shift
if bit_offset > 0:
temp4byte = temp4byte >> bit_offset
# mask left part
if bit_count < 32:
temp4byte &= mask
sign_bit = temp4byte & sign_bit_mask # assumes return in little endian, to be reviewed
if sign_bit: # negative value, sign extend
temp4byte |= sign_extend
buf[i] = temp4byte
else:
for i in range(number_of_records):
memcpy(&temp4, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
temp4byte = temp4[0]<<24 | temp4[1]<<16 | temp4[2]<<8 | temp4[3] # swap bytes
# right shift
if bit_offset > 0:
temp4byte = temp4byte >> bit_offset
# mask left part
if bit_count < 32:
temp4byte &= mask
sign_bit = temp4byte & sign_bit_mask # assumes return in little endian, to be reviewed
if sign_bit: # negative value, sign extend
temp4byte |= sign_extend
buf[i] = temp4byte
return buf
else: # on 3 bytes
if swap == 0:
for i in range(number_of_records):
memcpy(&temp4byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
# right shift
if bit_offset > 0:
temp4byte = temp4byte >> bit_offset
# mask left part
if bit_count < 24:
temp4byte &= mask
sign_bit = temp4byte & sign_bit_mask # assumes return in little endian, to be reviewed
if sign_bit: # negative value, sign extend
temp4byte |= sign_extend
buf[i] = temp4byte
else:
for i in range(number_of_records):
memcpy(&temp3, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
temp4byte = temp3[0]<<16 | temp3[1]<<8 | temp3[2] # swap bytes
# right shift
if bit_offset > 0:
temp4byte = temp4byte >> bit_offset
# mask left part
if bit_count < 24:
temp4byte &= mask
sign_bit = temp4byte & sign_bit_mask # assumes return in little endian, to be reviewed
if sign_bit: # negative value, sign extend
temp4byte |= sign_extend
buf[i] = temp4byte
return buf
cdef inline read_unsigned_longlong(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg,
unsigned long bit_count, unsigned char bit_offset, unsigned long n_bytes, unsigned char swap):
cdef np.ndarray[np.uint64_t] buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef unsigned long long mask = ((1 << bit_count) - 1)
cdef unsigned long long temp8byte = 0
cdef unsigned char temp8[8]
cdef unsigned char temp7[7]
cdef unsigned char temp6[6]
cdef unsigned char temp5[5]
if bit_count == 64:
for i in range(number_of_records):
memcpy(&temp8byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
buf[i] = temp8byte
if swap == 0:
return buf
else:
return buf.byteswap()
elif n_bytes == 8:
if swap == 0:
for i in range(number_of_records):
memcpy(&temp8byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 64:
temp8byte &= mask
buf[i] = temp8byte
else:
for i in range(number_of_records):
memcpy(&temp8, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
temp8byte = temp8[0]<<56 | temp8[1]<<48 | temp8[2]<<40 | temp8[3]<<32 | \
temp8[4]<<24 | temp8[5]<<16 | temp8[6]<<8 | temp8[7] # swap bytes
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 64:
temp8byte &= mask
buf[i] = temp8byte
elif n_bytes == 7:
if swap == 0:
for i in range(number_of_records):
memcpy(&temp8byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 56:
temp8byte &= mask
buf[i] = temp8byte
else:
for i in range(number_of_records):
memcpy(&temp7, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
temp8byte = temp7[0]<<48 | temp7[1]<<40 | temp7[2]<<32 | \
temp7[3]<<24 | temp7[4]<<16 | temp7[5]<<8 | temp7[6] # swap bytes
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 56:
temp8byte &= mask
buf[i] = temp8byte
elif n_bytes == 6:
if swap == 0:
for i in range(number_of_records):
memcpy(&temp8byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 48:
temp8byte &= mask
buf[i] = temp8byte
else:
for i in range(number_of_records):
memcpy(&temp6, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
temp8byte = temp6[0]<<40 | temp6[1]<<32 | temp6[2]<<24 | \
temp6[3]<<16 | temp6[4]<<8 | temp6[5] # swap bytes
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 48:
temp8byte &= mask
buf[i] = temp8byte
elif n_bytes == 5:
if swap == 0:
for i in range(number_of_records):
memcpy(&temp8byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 32:
temp8byte &= mask
buf[i] = temp8byte
else:
for i in range(number_of_records):
memcpy(&temp5, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
temp8byte = temp5[0]<<32 | temp5[1]<<24 | \
temp5[2]<<16 | temp5[3]<<8 | temp5[4] # swap bytes
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 32:
temp8byte &= mask
buf[i] = temp8byte
return buf
cdef inline read_signed_longlong(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg,
unsigned long bit_count, unsigned char bit_offset, unsigned long n_bytes, unsigned char swap):
cdef np.ndarray[np.int64_t] buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef unsigned long long mask = ((1 << bit_count) - 1)
cdef long long temp8byte = 0
cdef unsigned long sign_bit = 0
cdef unsigned long long sign_bit_mask = (1 << (bit_count-1))
cdef unsigned long long sign_extend = ((1 << (64 - bit_count)) - 1) << bit_count
cdef unsigned char temp8[8]
cdef unsigned char temp7[7]
cdef unsigned char temp6[6]
cdef unsigned char temp5[5]
if bit_count == 64:
for i in range(number_of_records):
memcpy(&temp8byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
buf[i] = temp8byte
if swap == 0:
return buf
else:
return buf.byteswap()
elif n_bytes == 8:
if swap == 0:
for i in range(number_of_records):
memcpy(&temp8byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 64:
temp8byte &= mask
sign_bit = temp8byte & sign_bit_mask
if sign_bit: # negative value, sign extend
temp8byte |= sign_extend
buf[i] = temp8byte
else:
for i in range(number_of_records):
memcpy(&temp8, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
temp8byte = temp8[0]<<56 | temp8[1]<<48 | temp8[2]<<40 | temp8[3]<<32 | \
temp8[4]<<24 | temp8[5]<<16 | temp8[6]<<8 | temp8[7] # swap bytes
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 64:
temp8byte &= mask
sign_bit = temp8byte & sign_bit_mask
if sign_bit: # negative value, sign extend
temp8byte |= sign_extend
buf[i] = temp8byte
elif n_bytes == 7:
if swap == 0:
for i in range(number_of_records):
memcpy(&temp8byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 56:
temp8byte &= mask
sign_bit = temp8byte & sign_bit_mask
if sign_bit: # negative value, sign extend
temp8byte |= sign_extend
buf[i] = temp8byte
else:
for i in range(number_of_records):
memcpy(&temp7, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
temp8byte = temp7[0]<<48 | temp7[1]<<40 | temp7[2]<<32 | \
temp7[3]<<24 | temp7[4]<<16 | temp7[5]<<8 | temp7[6] # swap bytes
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 56:
temp8byte &= mask
sign_bit = temp8byte & sign_bit_mask
if sign_bit: # negative value, sign extend
temp8byte |= sign_extend
buf[i] = temp8byte
elif n_bytes == 6:
if swap == 0:
for i in range(number_of_records):
memcpy(&temp8byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 48:
temp8byte &= mask
sign_bit = temp8byte & sign_bit_mask
if sign_bit: # negative value, sign extend
temp8byte |= sign_extend
buf[i] = temp8byte
else:
for i in range(number_of_records):
memcpy(&temp6, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
temp8byte = temp6[0]<<40 | temp6[1]<<32 | temp6[2]<<24 | \
temp6[3]<<16 | temp6[4]<<8 | temp6[5] # swap bytes
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 48:
temp8byte &= mask
sign_bit = temp8byte & sign_bit_mask
if sign_bit: # negative value, sign extend
temp8byte |= sign_extend
buf[i] = temp8byte
elif n_bytes == 5:
if swap == 0:
for i in range(number_of_records):
memcpy(&temp8byte, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 40:
temp8byte &= mask
sign_bit = temp8byte & sign_bit_mask
if sign_bit: # negative value, sign extend
temp8byte |= sign_extend
buf[i] = temp8byte
else:
for i in range(number_of_records):
memcpy(&temp5, &bit_stream[pos_byte_beg + record_byte_size * i], n_bytes)
temp8byte = temp5[0]<<32 | temp5[1]<<24 | \
temp5[2]<<16 | temp5[3]<<8 | temp5[4] # swap bytes
# right shift
if bit_offset > 0:
temp8byte = temp8byte >> bit_offset
# mask left part
if bit_count < 40:
temp8byte &= mask
sign_bit = temp8byte & sign_bit_mask
if sign_bit: # negative value, sign extend
temp8byte |= sign_extend
buf[i] = temp8byte
return buf
cdef inline read_byte(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg, unsigned long n_bytes,
unsigned long bit_count, unsigned char bit_offset):
cdef np.ndarray buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef unsigned long pos_byte_end = pos_byte_beg + n_bytes
for i in range(number_of_records):
buf[i] = bytes(bit_stream[pos_byte_beg + record_byte_size * i:\
pos_byte_end + record_byte_size * i])
return buf
cdef inline read_array(const char* bit_stream, str record_format, unsigned long long number_of_records,
unsigned long record_byte_size, unsigned long pos_byte_beg, unsigned long n_bytes,
unsigned long bit_count, unsigned char bit_offset, unsigned char swap):
cdef np.ndarray buf = np.empty(number_of_records, dtype=record_format) # return numpy array
cdef unsigned long long i
cdef unsigned long pos_byte_end = pos_byte_beg + n_bytes
for i in range(number_of_records):
buf[i] = np.fromstring(bit_stream[pos_byte_beg + record_byte_size * i:\
pos_byte_end + record_byte_size * i], dtype=record_format)
if swap == 0:
return buf
else:
return buf.byteswap()
def unsorted_data_read4(record, info, bytes tmp,
const unsigned short record_id_size,
const unsigned long long data_block_length):
""" reads only the channels using offset functions, channel by channel within unsorted data
Parameters
------------
record : class
record class
info: class
info class
tmp : bytes
byte stream
record_id_size : unsigned short
record id length
data_block_length : unsigned long long
length of data block minus header
Returns
--------
buf : array
data array
"""
cdef const char* bit_stream = PyBytes_AsString(tmp)
cdef unsigned long long position = 0
cdef unsigned char record_id_char = 0
cdef unsigned short record_id_short = 0
cdef unsigned long record_id_long = 0
cdef unsigned long long record_id_long_long = 0
# initialise data structure
# key is channel name
cdef dict buf = {}
cdef dict VLSD = {}
cdef dict pos_byte_beg = {}
cdef dict pos_byte_end = {}
cdef dict c_format_structure = {}
cdef dict byte_length = {}
cdef dict numpy_format = {}
# key is record id
cdef dict index = {}
cdef dict CGrecordLength = {}
cdef dict VLSD_flag = {}
cdef dict VLSD_CG_name = {}
cdef dict VLSD_CG_signal_data_type = {}
cdef dict channel_name_set = {}
for record_id in record:
if record[record_id]['record'].Flags & 0b1:
VLSD_flag[record_id] = True
VLSD[record[record_id]['record'].VLSD_CG[record_id]['channelName']] = []
VLSD_CG_name[record_id] = record[record_id]['record'].VLSD_CG[record_id]['channelName']
VLSD_CG_signal_data_type[record_id] = record[record_id]['record'].VLSD_CG[record_id]['channel'].signal_data_type(info)
else:
VLSD_flag[record_id] = False
for Channel in record[record_id]['record'].values():
#if not Channel.VLSD_CG_Flag:
buf[Channel.name] = np.empty((record[record_id]['record'].numberOfRecords,),
dtype='V{}'.format(Channel.nBytes_aligned), order ='C')
numpy_format[Channel.name] = Channel.data_format(info)
pos_byte_beg[Channel.name] = record_id_size + Channel.byteOffset
pos_byte_end[Channel.name] = pos_byte_beg[Channel.name] + Channel.nBytes_aligned
index[record_id] = 0
CGrecordLength[record_id] = record[record_id]['record'].CGrecordLength
channel_name_set[record_id] = record[record_id]['record'].channelNames
# read data
if record_id_size == 1:
while position < data_block_length:
memcpy(&record_id_char, &bit_stream[position], 1)
position, buf, VLSD, index = unsorted_read4(bit_stream, tmp, record_id_char, 1,
position, buf, VLSD, pos_byte_beg, pos_byte_end,
c_format_structure, index, CGrecordLength,
VLSD_flag, VLSD_CG_name, VLSD_CG_signal_data_type, channel_name_set)
elif record_id_size == 2:
while position < data_block_length:
memcpy(&record_id_short, &bit_stream[position], 2)
position, buf, VLSD, index = unsorted_read4(bit_stream, tmp, record_id_short, 2,
position, buf, VLSD, pos_byte_beg, pos_byte_end,
c_format_structure, index, CGrecordLength,
VLSD_flag, VLSD_CG_name, VLSD_CG_signal_data_type, channel_name_set)
elif record_id_size == 3:
while position < data_block_length:
memcpy(&record_id_long, &bit_stream[position], 4)
position, buf, VLSD, index = unsorted_read4(bit_stream, tmp, record_id_long, 4,
position, buf, VLSD, pos_byte_beg, pos_byte_end,
c_format_structure, index, CGrecordLength,
VLSD_flag, VLSD_CG_name, VLSD_CG_signal_data_type, channel_name_set)
elif record_id_size == 4:
while position < data_block_length:
memcpy(&record_id_long_long, &bit_stream[position], 8)
position, buf, VLSD, index = unsorted_read4(bit_stream, tmp, record_id_long_long, 8,
position, buf, VLSD, pos_byte_beg, pos_byte_end,
c_format_structure, index, CGrecordLength,
VLSD_flag, VLSD_CG_name, VLSD_CG_signal_data_type, channel_name_set)
# changing from bytes type to desired type
if buf:
for name in buf.keys():
buf[name] = buf[name].view(dtype=numpy_format[name])
# convert list to array for VLSD only
if VLSD:
for channel_name in VLSD:
VLSD[channel_name] = np.array(VLSD[channel_name])
buf.update(VLSD)
return buf
cdef inline unsorted_read4(const char* bit_stream, bytes tmp, record_id,
unsigned short record_id_size, unsigned long long position,
buf, VLSD, pos_byte_beg, pos_byte_end, c_format_structure,
index, CGrecordLength, VLSD_flag, VLSD_CG_name, VLSD_CG_signal_data_type,
channel_name_set):
cdef unsigned long VLSDLen = 0
if not VLSD_flag[record_id]: # not VLSD CG)
for channel_name in channel_name_set[record_id]: # list of channel classes
buf[channel_name][index[record_id]] = \
tmp[position + pos_byte_beg[channel_name]:position + pos_byte_end[channel_name]]
index[record_id] += 1
position += CGrecordLength[record_id]
else: # VLSD CG
position += <unsigned long long> record_id_size
memcpy(&VLSDLen, &bit_stream[position], 4) # VLSD length
position += 4
signal_data_type = VLSD_CG_signal_data_type[record_id]
if signal_data_type == 6:
temp = bit_stream[position:position + VLSDLen - 1].decode('ISO8859')
elif signal_data_type == 7:
temp = bit_stream[position:position + VLSDLen - 1].decode('utf-8')
elif signal_data_type == 8:
temp = bit_stream[position:position + VLSDLen - 1].decode('<utf-16')
elif signal_data_type == 9:
temp = bit_stream[position:position + VLSDLen - 1].decode('>utf-16')
VLSD[VLSD_CG_name[record_id]].append(temp)
position += <unsigned long long> VLSDLen
return position, buf, VLSD, index
def sd_data_read(unsigned short signal_data_type, bytes sd_block,
unsigned long long sd_block_length, unsigned long long n_records):
""" Reads vlsd channel from its SD Block bytes
Parameters
----------------
signal_data_type : int
sd_block : bytes
SD Block bytes
sd_block_length: int
SD Block data length (header not included)
n_records: int
number of records
Returns
-----------
array
"""
cdef const char* bit_stream = PyBytes_AsString(sd_block)
cdef unsigned long max_len = 0
cdef unsigned long vlsd_len = 0
cdef unsigned long *VLSDLen = <unsigned long *> PyMem_Malloc(n_records * sizeof(unsigned long))
cdef unsigned long long *pointer = <unsigned long long *> PyMem_Malloc(n_records * sizeof(unsigned long long))
cdef unsigned long long rec = 0
if not VLSDLen or not pointer:
raise MemoryError()
try:
pointer[0] = 0
VLSDLen[0] = 0
for rec from 0 <= rec < n_records - 1 by 1:
memcpy(&vlsd_len, &bit_stream[pointer[rec]], 4)
VLSDLen[rec] = vlsd_len
pointer[rec + 1] = VLSDLen[rec] + 4 + pointer[rec]
if VLSDLen[rec] > max_len:
max_len = VLSDLen[rec]
memcpy(&vlsd_len, &bit_stream[pointer[rec]], 4)
VLSDLen[rec] = vlsd_len
if VLSDLen[rec] > max_len:
max_len = VLSDLen[rec]
if max_len != 0:
if signal_data_type < 10:
if signal_data_type == 6:
channel_format = 'ISO8859'
elif signal_data_type == 7:
channel_format = 'utf-8'
elif signal_data_type == 8:
channel_format = '<utf-16'
elif signal_data_type == 9:
channel_format = '>utf-16'
else:
channel_format = 'utf-8'
printf('signal_data_type should have fixed length')
return equalize_string_length(bit_stream, pointer, VLSDLen, max_len, n_records, channel_format)
else: # byte arrays or mime types
return equalize_byte_length(bit_stream, pointer, VLSDLen, max_len, n_records)
else:
printf('VLSD channel could not be properly read\n')
return None
finally:
PyMem_Free(pointer)
PyMem_Free(VLSDLen)
cdef inline equalize_byte_length(const char* bit_stream, unsigned long long *pointer, unsigned long *VLSDLen,
unsigned long max_len, unsigned long long n_records):
cdef np.ndarray output = np.zeros((n_records, ), dtype='V{}'.format(max_len))
cdef unsigned long rec = 0