-
Notifications
You must be signed in to change notification settings - Fork 2
/
examples.py
218 lines (149 loc) · 6.74 KB
/
examples.py
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
# -*- coding: utf-8 -*-
"""
Copyright (C) 2019 Event-driven Perception for Robotics
Authors: Sim Bamford
This program is free software: you can redistribute it and/or modify it under
the terms of the GNU General Public License as published by the Free Software
Foundation, either version 3 of the License, or (at your option) any later version.
This program is distributed in the hope that it will be useful, but WITHOUT ANY
WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A
PARTICULAR PURPOSE. See the GNU General Public License for more details.
You should have received a copy of the GNU General Public License along with
this program. If not, see <https://www.gnu.org/licenses/>.
Intended as part of bimvee (Batch Import, Manipulation, Visualisation and Export of Events etc)
This script contains a set of examples of how to use the functions of the bimvee library.
In each case, change the file paths as required to point toyour own example data.
"""
#%% Preliminaries - set your paths as necessary
import os, sys # A system-specific prefix, for working between linux and windows
prefix = 'C:/' if os.name == 'nt' else '/home/sbamford/'
sys.path.append(os.path.join(prefix, 'repos/event-driven-python-dev/python/libraries/bimvee')) # A path to this library
#sys.path.insert(0, os.path.join(prefix, 'repos/event-driven-python-dev/python/libraries/bimvee')) # A path to this library
#%% IMPORT FUNCTIONS
#%% Import from yarp
from importIitYarp import importIitYarp
filePathOrName = os.path.join(prefix, "data/2019_11_11_AikoImu/tripod_pitch")
# If the number of bits dedicated to the timestamp have been limited
# prior to dumping, then match this with the 'tsBits' parameter
imported = importIitYarp(filePathOrName=filePathOrName, tsBits=30)
#%% Inspection of a rosbag
'''
To just inspect the connections of a rosbag file , pass in an empty template.
This doesn't import any data but prints out which connections are present
in the file. You can then construct a template to import the file as desired.
'''
from importRpgDvsRos import importRpgDvsRos
filePathOrName = os.path.join(prefix, 'data/rpg/shapes_rotation.bag')
inspected = importRpgDvsRos(filePathOrName=filePathOrName)
#%% Import Rpg Event-Camera Dataset
# http://rpg.ifi.uzh.ch/davis_data.html
from importRpgDvsRos import importRpgDvsRos
filePathOrName = os.path.join(prefix, 'data/rpg/shapes_rotation.bag')
template = {
'ch0': {
'dvs': '/dvs/events',
'frame': '/dvs/image_raw',
'pose6q': '/optitrack/davis',
'cam': '/dvs/camera_info',
'imu': '/dvs/imu'
}
}
imported = importRpgDvsRos(filePathOrName=filePathOrName, template=template)
#%% import Penn MVSEC
from importPennMvsec import importPennMvsecDavis, importPennMvsecGt
filePathOrName = os.path.join(prefix, 'data/mvsec/indoor_flying1_data.bag')
'''
Optionally, override the default template ...
template = {
'left': {
'dvs': '/davis/left/events',
'frame': '/davis/left/image_raw',
'imu': '/davis/left/imu',
'cam': '/davis/left/camera_info',
}, 'right': {
'dvs': '/davis/right/events',
'frame': '/davis/right/image_raw',
'imu': '/davis/right/imu',
'cam': '/davis/right/camera_info',
}
}
'''
importedDavis = importPennMvsecDavis(filePathOrName=filePathOrName)
filePathOrName = os.path.join(prefix, 'data/mvsec/indoor_flying1_gt.bag')
importedGt = importPennMvsecGt(filePathOrName=filePathOrName)
#imported = [importedDavis, importedGt]
# Rafactor into single container
container = importedDavis
container['data'].update(importedGt['data'])
#%% Import realsense
from importIntelRealsense import importIntelRealsense
filePathOrName = os.path.join(prefix, '/data/2019_10_23_static/20191023_165520.bag')
imported = importIntelRealsense(filePathOrName=filePathOrName)
#%% MANIPULATION FUNCTIONS
#%% Cropping a dataset to a desired time range
from split import cropTime
cropped = cropTime(imported, minTime=35, maxTime=38.5)
#%% Cropping a dataset to a desired spatial range
# works for dvs and derived data types 2020_01 doesn't yet work for frame datatype
from split import cropSpace
# This example takes all events with x in 9-19 inclusive, and with y in 0-9 inclusive
cropped = cropSpace(imported, minX=9, maxX=19, maxY= 9)
#%% Splitting a dataset by labels
from split import splitByLabel, selectByLabel
# select your labelled data from an import (alternatively label it using some processing)
labelledData = imported['data']['right']['dvslbl']
splitData = splitByLabel(labelledData, 'lbl') # 'lbl' in this case is the name of the field that contains the labels
# Alternatively, select a single label
selectedData = selectByLabel(labelledData, 'lbl', 3) # in this case, 3 is the label you want to isolate
#%% VISUALISATION FUNCTIONS
#%% Info
from info import info
info(imported)
#%% Timestamp info only
from info import infoTsForImportedDicts
infoTsForImportedDicts(imported)
#%% General function for plotting data present in channels according to its type
from plot import plot
plot(imported, zeroT=True, polarised=True)
#%% More specific example of taking particular datatypes from an import and
# visualising them
from plotDvsContrast import plotDvsContrast
from plotFrame import plotFrame
from plotPose import plotPose
# Unpack
cam = imported['data']['davis']['cam']
events = imported['data']['davis']['dvs']
frames = imported['data']['davis']['frame']
poses = imported['data']['extra']['pose6q']
if 'frame' in imported['data']['extra']:
depthMaps = imported['data']['extra']['frame']
else:
depthMaps = None
plotDvsContrast(events, numPlots=2)
plotFrame(frames, numPlots=15)
plotPose(poses)
# Using 'frame' datatype to import and visualise depth maps
if depthMaps:
plotFrame(depthMaps, numPlots=2)
#%% Distribute the sub-plots in a visualisation of dvs event images
# by event density rather than time
from plotDvsContrast import plotDvs
plotDvs(imported, numPlots=6, distributeBy='events')
#%% This function for visualising dvs surface-of-active-events-(SAE)-like
# visualisation is not included in standard plot function.
from plotDvsLastTs import plotDvsLastTs
plotDvsLastTs(imported)
#%% EXPORT FUNCTIONS
#%% Export to yarp
from exportIitYarp import exportIitYarp
exportIitYarp(imported,
exportFilePath= 'C:/data/mvsec/indoorFlying1Yarp',
pathForPlayback= '/home/sbamford/data/mvsec/indoorFlying1Yarp')
#%% Choose to export only specific datatypes;
# overwrite data if the export is already there
from exportIitYarp import exportIitYarp
exportIitYarp(imported,
exportFilePath= 'C:/data/rpg/shapes_rotation',
pathForPlayback= '/home/sbamford/data/rpg/shapes_rotation',
dataTypes = ['imu', 'dvs'],
overwrite=True)