pinocchio-device: Add YAML parsing to make the map with the sensors.

WIP.
4 jobs for topic/pinocchio-device in 4 minutes and 36 seconds (queued for 3 seconds)