Model from Joska et al. 2021 ICRA please cite: https://arxiv.org/abs/2103.13282