コード例 #1
0
ファイル: st_accel_i2c.c プロジェクト: ChineseDr/linux
static int st_accel_i2c_probe(struct i2c_client *client,
                              const struct i2c_device_id *id)
{
    struct iio_dev *indio_dev;
    struct st_sensor_data *adata;
    int err;

    indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*adata));
    if (!indio_dev)
        return -ENOMEM;

    adata = iio_priv(indio_dev);
    st_sensors_of_i2c_probe(client, st_accel_of_match);

    st_sensors_i2c_configure(indio_dev, client, adata);

    err = st_accel_common_probe(indio_dev);
    if (err < 0)
        return err;

    return 0;
}
コード例 #2
0
static int st_gyro_i2c_probe(struct i2c_client *client,
						const struct i2c_device_id *id)
{
	struct iio_dev *indio_dev;
	struct st_sensor_data *gdata;
	int err;

	indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*gdata));
	if (!indio_dev)
		return -ENOMEM;

	gdata = iio_priv(indio_dev);
	gdata->dev = &client->dev;
	st_sensors_of_i2c_probe(client, st_gyro_of_match);

	st_sensors_i2c_configure(indio_dev, client, gdata);

	err = st_gyro_common_probe(indio_dev,
				(struct st_sensors_platform_data *)&gyro_pdata);
	if (err < 0)
		return err;

	return 0;
}