Driver and utils for the NIFTi robot