3. Sensor驱动核心：注册流程、s_power回调与初始化序列

Camera Sensor驱动是V4L2子系统中最为关键的模块之一，它直接与硬件交互，负责图像数据的采集与传输。本章将深入剖析Sensor驱动的注册流程、电源管理回调以及初始化序列的实现细节，帮助开发者掌握驱动开发的核心技能。

3.1 Sensor驱动注册流程

Sensor驱动的注册遵循V4L2子系统的标准框架，主要分为以下步骤：

  1. 分配与初始化结构体：使用v4l2_subdev_alloc()或静态定义struct v4l2_subdev，并填充核心操作函数指针。
  2. 设置子设备核心操作：实现struct v4l2_subdev_core_ops中的s_power、ioctl等回调。
  3. 设置视频操作：实现struct v4l2_subdev_video_ops中的s_stream、g_mbus_config等回调。
  4. 设置传感器特有操作：实现struct v4l2_subdev_sensor_ops（可选）。
  5. 注册子设备：调用v4l2_async_register_subdev()或v4l2_i2c_subdev_init()将Sensor注册到V4L2框架。
  6. 媒体实体注册：若使用Media Controller框架，需调用media_entity_pads_init()初始化pad并注册实体。
关键点：Sensor驱动通常作为I2C客户端设备注册，因此需要同时实现struct i2c_driver的probe和remove函数。

以下是一个典型的Sensor驱动注册代码框架：

static int sensor_probe(struct i2c_client *client,
                        const struct i2c_device_id *id)
{
    struct sensor_dev *sensor = devm_kzalloc(&client->dev, sizeof(*sensor), GFP_KERNEL);
    if (!sensor)
        return -ENOMEM;

    v4l2_i2c_subdev_init(&sensor->sd, client, &sensor_subdev_ops);
    sensor->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;

    /* 初始化电源管理 */
    sensor->power_gpio = devm_gpiod_get(&client->dev, "power", GPIOD_OUT_LOW);
    if (IS_ERR(sensor->power_gpio))
        return PTR_ERR(sensor->power_gpio);

    /* 注册异步子设备 */
    return v4l2_async_register_subdev(&sensor->sd);
}

static const struct i2c_device_id sensor_id[] = {
    { "sensor_model", 0 },
    { }
};
MODULE_DEVICE_TABLE(i2c, sensor_id);

static struct i2c_driver sensor_i2c_driver = {
    .driver = {
        .name = "sensor_driver",
    },
    .probe    = sensor_probe,
    .remove   = sensor_remove,
    .id_table = sensor_id,
};
module_i2c_driver(sensor_i2c_driver);

3.2 s_power回调实现

s_power是V4L2子设备核心操作中最重要的电源管理回调，它在Sensor上电和下电时被调用。正确的实现直接影响系统的功耗和图像质量。

回调状态 调用时机 典型操作
s_power(1) Sensor上电时 使能电源GPIO、时钟、复位、初始化寄存器序列
s_power(0) Sensor下电时 停止数据流、关闭时钟、禁用电源GPIO、进入低功耗模式
注意：s_power可能被多次嵌套调用，驱动必须使用引用计数来确保电源状态的正确切换。通常使用atomic_t或mutex保护电源计数。

以下是一个带引用计数的s_power实现示例：

static int sensor_s_power(struct v4l2_subdev *sd, int on)
{
    struct sensor_dev *sensor = to_sensor_dev(sd);
    int ret = 0;

    mutex_lock(&sensor->power_lock);

    if (on) {
        if (sensor->power_count == 0) {
            /* 第一次上电：使能硬件资源 */
            ret = regulator_enable(sensor->regulator);
            if (ret)
                goto unlock;

            gpiod_set_value(sensor->power_gpio, 1);
            usleep_range(1000, 2000);  /* 等待电源稳定 */

            /* 初始化寄存器序列 */
            ret = sensor_init_sequence(sd);
            if (ret) {
                gpiod_set_value(sensor->power_gpio, 0);
                regulator_disable(sensor->regulator);
                goto unlock;
            }
        }
        sensor->power_count++;
    } else {
        if (sensor->power_count == 1) {
            /* 最后一次下电：关闭硬件资源 */
            gpiod_set_value(sensor->power_gpio, 0);
            regulator_disable(sensor->regulator);
        }
        sensor->power_count--;
    }

unlock:
    mutex_unlock(&sensor->power_lock);
    return ret;
}

3.3 初始化序列设计

Sensor初始化序列是驱动中最为复杂的部分，它决定了Sensor的工作模式、输出格式和图像质量。初始化序列通常以寄存器-值对的形式存储在数组中，由驱动在s_power或s_stream时写入。

3.3.1 初始化序列结构

典型的初始化序列包含以下阶段：

  • 软件复位：复位Sensor内部逻辑，确保寄存器处于默认状态。
  • 时钟配置：设置PLL倍频、分频系数，生成所需的像素时钟和帧率。
  • 模拟电路配置：设置ADC增益、偏置电流、参考电压等模拟参数。
  • 输出格式配置：设置输出分辨率、数据格式（RAW10/RAW12）、MIPI通道数。
  • 曝光与增益配置：设置默认曝光时间和模拟/数字增益。
  • 测试模式配置：可选，用于调试时输出测试图案。
最佳实践：将初始化序列按功能模块分组，使用结构体数组存储，便于维护和调试。每个寄存器写入操作应包含适当的延时，确保Sensor内部状态机稳定。

以下是一个初始化序列的数据结构定义：

struct sensor_reg {
    u16 addr;
    u8 val;
    u16 delay_ms;  /* 写入后的延时，单位毫秒 */
};

static const struct sensor_reg sensor_init_seq[] = {
    /* 软件复位 */
    { 0x0103, 0x01, 10 },  /* 复位命令 */
    { 0x0103, 0x00, 5 },   /* 释放复位 */

    /* 时钟配置 */
    { 0x0305, 0x04, 0 },   /* PLL倍频系数 */
    { 0x0307, 0x01, 0 },   /* PLL分频系数 */
    { 0x0309, 0x0A, 1 },   /* 像素时钟分频 */

    /* 输出格式：1920x1080 RAW10 4-lane MIPI */
    { 0x3808, 0x07, 0 },   /* 输出宽度高字节 */
    { 0x3809, 0x80, 0 },   /* 输出宽度低字节 */
    { 0x380A, 0x04, 0 },   /* 输出高度高字节 */
    { 0x380B, 0x38, 0 },   /* 输出高度低字节 */
    { 0x3035, 0x11, 0 },   /* MIPI 4-lane模式 */

    /* 默认曝光与增益 */
    { 0x3500, 0x00, 0 },   /* 曝光时间高字节 */
    { 0x3501, 0x10, 0 },   /* 曝光时间中字节 */
    { 0x3502, 0x00, 0 },   /* 曝光时间低字节 */
    { 0x350A, 0x00, 0 },   /* 模拟增益 */
    { 0x350B, 0x10, 0 },   /* 数字增益 */

    /* 结束标记 */
    { 0xFFFF, 0xFF, 0 },
};

3.3.2 初始化序列执行函数

驱动需要提供一个遍历并写入初始化序列的函数：

static int sensor_write_reg(struct v4l2_subdev *sd, u16 addr, u8 val)
{
    struct i2c_client *client = v4l2_get_subdevdata(sd);
    struct i2c_msg msg;
    u8 buf[3] = { addr >> 8, addr & 0xFF, val };

    msg.addr = client->addr;
    msg.flags = 0;
    msg.len = 3;
    msg.buf = buf;

    if (i2c_transfer(client->adapter, &msg, 1) != 1)
        return -EIO;

    return 0;
}

static int sensor_init_sequence(struct v4l2_subdev *sd)
{
    const struct sensor_reg *reg = sensor_init_seq;
    int ret;

    while (reg->addr != 0xFFFF) {
        ret = sensor_write_reg(sd, reg->addr, reg->val);
        if (ret)
            return ret;

        if (reg->delay_ms)
            usleep_range(reg->delay_ms * 1000,
                         (reg->delay_ms + 1) * 1000);
        reg++;
    }

    return 0;
}

3.4 Sensor驱动核心架构图

下图展示了Sensor驱动在V4L2框架中的核心架构与数据流：

Sensor驱动核心架构图 Sensor驱动核心架构与数据流 用户空间 (Applications / V4L2 API) 内核空间 (Kernel Space) V4L2核心框架 Media Controller I2C核心层 Sensor驱动 (v4l2_subdev + i2c_driver) s_power | s_stream | init_sequence | register_rw 硬件层：Camera Sensor (I2C控制 + MIPI CSI-2数据) 说明： Sensor驱动通过I2C总线与硬件通信，注册为V4L2子设备，通过s_power/s_stream回调控制电源和流状态。 初始化序列在s_power(1)时执行，确保Sensor进入预期的工作模式。

3.5 调试与验证

在开发Sensor驱动时，以下调试手段可以帮助快速定位问题：

  • I2C寄存器读写验证：使用i2cget/i2cset工具手动读写Sensor寄存器，验证硬件通信是否正常。
  • V4L2子设备调试节点：通过/sys/kernel/debug/v4l2-subdev/查看子设备状态。
  • 初始化序列日志：在sensor_init_sequence中添加dev_dbg输出每次写入的寄存器地址和值。
  • 电源状态跟踪：在s_power中添加引用计数日志，检查电源是否被正确管理。
常见问题：初始化序列写入后Sensor无输出，通常由以下原因导致：
1. 寄存器地址或值错误（对照datasheet逐位检查）。
2. 写入后缺少必要的延时（Sensor内部状态机未稳定）。
3. 电源时序错误（AVDD/DVDD/IOVDD上电顺序不符合规格书要求）。

3.6 本章小结

本章详细介绍了Camera Sensor驱动的核心实现：

  • 注册流程：通过v4l2_i2c_subdev_init和v4l2_async_register_subdev将Sensor注册到V4L2框架。
  • s_power回调：使用引用计数管理电源状态，确保上电/下电操作的原子性和正确性。
  • 初始化序列：以寄存器数组形式组织，按阶段配置时钟、输出格式和模拟参数，是驱动稳定工作的基础。

掌握这些核心机制后，开发者可以快速适配新的Sensor型号，并为后续的DMA传输和图像数据流分析打下坚实基础。

← 上一章 📖 返回目录 下一章 →