Driver seems to work. Need to verify with more sensors.