Add Sensorhub driver code