of Subarctic Forests Philippe Babin, Philippe Dandurand, Vladimr - - PowerPoint PPT Presentation

of subarctic forests
SMART_READER_LITE
LIVE PREVIEW

of Subarctic Forests Philippe Babin, Philippe Dandurand, Vladimr - - PowerPoint PPT Presentation

12th FSR conference, Tokyo, 2019 Large-scale 3D Mapping of Subarctic Forests Philippe Babin, Philippe Dandurand, Vladimr Kubelka, Philippe Gigure and Franois Pomerleau Subarctic Boreal Forest: Research Opportunity 2/27 Naive approach


slide-1
SLIDE 1

Large-scale 3D Mapping

  • f Subarctic Forests

Philippe Babin, Philippe Dandurand, Vladimír Kubelka, Philippe Giguère and François Pomerleau

12th FSR conference, Tokyo, 2019

slide-2
SLIDE 2

Subarctic Boreal Forest: Research Opportunity

2/27

slide-3
SLIDE 3

Our approach Naive approach

3/27

slide-4
SLIDE 4

Applications

4/27

slide-5
SLIDE 5

Local Wildlife Snow Fall Path obstacles Uneven Path

Challenge of Field Tests

5/27

slide-6
SLIDE 6

Mapping of Subarctic Boreal Forest - Challenges

 Unstructured environment → hard to map  Cold temperatures → noisy sensor  Few visual features due to snow → bad for vision based approaches

6/27

slide-7
SLIDE 7

Related Work

Williams et al., 2009

Paton et al., 2016

7/27

slide-8
SLIDE 8

Contributions

 Large-scale mapping of difficult environments  Novel fusion of IMU and GNSS measurement

inside of ICP

 Generated maps are crisp and without long term

drifts

 Introduced optimization to scale to large map 8/27

slide-9
SLIDE 9

Dataset Environment

4.1 km of forest path

9/27

slide-10
SLIDE 10

10/27

slide-11
SLIDE 11

Data Acquisition Platform

GNSS station (RTK)

RS-16 lidar

MTI-30 IMU

10h of battery life

11/27

slide-12
SLIDE 12

Iterative Closest Point (ICP)

T ?

12/27

slide-13
SLIDE 13

ICP

Tinit T

13/27

Iterative Closest Point (ICP)

slide-14
SLIDE 14

Iterative Closest Point (ICP)

14/27

slide-15
SLIDE 15

Sensor Fusion

Lidar ICP IMU GNSS SLAM Lidar Penalty-ICP IMU GNSS map pose Classical approach Our approach map pose

Covariance [1] pose [1] D. Landry, F. Pomerleau, and P. Giguère. CELLO-3D: Estimating the Covariance of ICP in the Real World. In ICRA, 2019 15/27 Point cloud Pose Covariance Pose/Covariance Legend

slide-16
SLIDE 16

Prior ICP with penalty ICP no penalty

Map of lake Dataset

350m

16/27

slide-17
SLIDE 17

ICP with penalty ICP no penalty

17/27

slide-18
SLIDE 18

Crispiness locally consistent Prior ICP With penalties ICP Without Penalties

18/27

slide-19
SLIDE 19

Prior ICP with penalty ICP no penalty

Map of forest Dataset

500m

19/27

slide-20
SLIDE 20

Prior ICP with penalty ICP no penalty

Map of forest Dataset

500m

20/27

slide-21
SLIDE 21

Map of skidoo Dataset

ICP no penalty ICP with penalty Prior 670m

21/27

slide-22
SLIDE 22

ICP no penalty ICP with penalty Prior 670m

22/27

Map of skidoo Dataset

slide-23
SLIDE 23

Full Map with Penalty

23/27

slide-24
SLIDE 24

Performance improvements

24/27

slide-25
SLIDE 25

Future work

25/27

slide-26
SLIDE 26

Future work – Project SNOW

26/27

slide-27
SLIDE 27

Questions?

27/27

slide-28
SLIDE 28

28

slide-29
SLIDE 29

Performance improvements

29/26

slide-30
SLIDE 30

Results: effect of penalties

30

slide-31
SLIDE 31

Penalty-ICP

  • Leverage ICP’s minimizer for sensor fusion
  • Add penalty term based on GNSS and IMU estimate
  • Introduced a point to Gaussian cost function
  • Minimize Mahalanobis distance instead of the Euclidian distance

31

slide-32
SLIDE 32

Full Map

32