Bugfix. The inverse matrix of the sensor poses was needed.