debug code example in Kernel

debug备忘

========================================= 1 ============================================

static ssize_t led_store_debug_mode(struct device *dev, struct device_attribute *attr,

const char *buf, size_t count)

{

sscanf(buf, "%d", &debug_mode);

pr_info("leds-qpnp: %s debug mode\n",

debug_mode ? "enabling" : "disabling");

return count;

}

static ssize_t led_show_debug_mode(struct device *dev,

struct device_attribute *attr, char *buf)

{

return snprintf(buf, PAGE_SIZE, "%d\n", debug_mode);

}

static DEVICE_ATTR(debug_mode, 0644, led_show_debug_mode, led_store_debug_mode);

static int __devinit qpnp_leds_probe(struct spmi_device *spmi)

{

rc = device_create_file(led->cdev.dev, &dev_attr_debug_mode);

if (rc)

device_remove_file(led->cdev.dev, &dev_attr_debug_mode);

break;

}

========================================= 2 ============================================

static ssize_t led_mode_store(struct device *dev,

struct device_attribute *attr,

const char *buf, size_t count)

{

struct qpnp_led_data *led;

unsigned long state;

struct led_classdev *led_cdev = dev_get_drvdata(dev);

ssize_t ret = -EINVAL;

ret = kstrtoul(buf, 10, &state);

if (ret)

return ret;

led = container_of(led_cdev, struct qpnp_led_data, cdev);

return count;

}

static ssize_t led_strobe_type_store(struct device *dev,

struct device_attribute *attr,

const char *buf, size_t count)

{

struct qpnp_led_data *led;

unsigned long state;

struct led_classdev *led_cdev = dev_get_drvdata(dev);

ssize_t ret = -EINVAL;

ret = kstrtoul(buf, 10, &state);

if (ret)

return ret;

led = container_of(led_cdev, struct qpnp_led_data, cdev);

return count;

}

static DEVICE_ATTR(led_mode, 0664, NULL, led_mode_store);

static DEVICE_ATTR(strobe, 0664, NULL, led_strobe_type_store);

static struct attribute *led_attrs[] = {

&dev_attr_led_mode.attr,

&dev_attr_strobe.attr,

NULL

};

static const struct attribute_group led_attr_group = {

.attrs = led_attrs,

};

static int __devinit qpnp_leds_probe(struct spmi_device *spmi)

{

rc = sysfs_create_group(&led->cdev.dev->kobj,

&led_attr_group);

}

static int __devexit qpnp_leds_remove(struct spmi_device *spmi)

{

sysfs_remove_group(&led_array[i].cdev.dev->kobj,

&led_attr_group);

break;

}

========================================= 3 ============================================

#if DEBUG_FLASH_CN

static int foo = 0;

static struct kobject *flash_kobj;

struct qpnp_led_data *flash_debug_led;

static ssize_t flash_show(struct kobject *kobj, struct kobj_attribute *attr,

char *buf) //cat

{

foo++;

pr_err("+++++ flash %s(ID: %d) +++++ \n", __func__, foo);

qpnp_dump_regs(flash_debug_led, flash_debug_regs, ARRAY_SIZE(flash_debug_regs));

pr_err("- - - - - - - - - - - - - - \n");

qpnp_dump_regs_2(flash_debug_led);

pr_err("----- flash %s(ID: %d) ----- \n", __func__, foo);

return sprintf(buf, "%d\n", foo);

}

static ssize_t flash_store(struct kobject *kobj, struct kobj_attribute *attr,

const char *buf, size_t count) //echo >

{

u8 val;

sscanf(buf, "%d", &foo);

pr_err("foo = %d.\n",foo);

pr_err("flash %s()++++ \n", __func__);

qpnp_dump_regs(flash_debug_led, flash_debug_regs, ARRAY_SIZE(flash_debug_regs));

pr_err("%s(), rewrite some registers start \n", __func__);

spmi_ext_register_readl(flash_debug_led->spmi_dev->ctrl, flash_debug_led->spmi_dev->sid, 0xd352, &val, sizeof(val));

pr_err("%s(), rewrite reg0xd352=0x%x to 0x%x.\n", __func__, val, val&0x7F);

val &= 0x7F;

spmi_ext_register_writel(flash_debug_led->spmi_dev->ctrl, flash_debug_led->spmi_dev->sid, 0xd352, &val, sizeof(val));

pr_err("%s(), rewrite some registers end \n", __func__);

return count;

}

static struct kobj_attribute flash_attribute =

__ATTR(fd_node, 0666, flash_show, flash_store);

/*

* Create a group of attributes so that we can create and destroy them all

* at once.

*/

static struct attribute *attrs[] = {

&flash_attribute.attr,

NULL, /* need to NULL terminate the list of attributes */

};

/*

* An unnamed attribute group will put all of the attributes directly in

* the kobject directory. If we specify a name, a subdirectory will be

* created for the attributes with the directory being the name of the

* attribute group.

*/

static struct attribute_group flash_attr_group = {

.attrs = attrs,

};

static int __devinit qpnp_leds_probe(struct spmi_device *spmi)

{

#if DEBUG_FLASH_CN

/*

* Create a simple kobject with the name of "flash_debug",

* located under /sys/kernel/

*

* As this is a simple directory, no uevent will be sent to

* userspace. That is why this function should not be used for

* any type of dynamic kobjects, where the name and number are

* not known ahead of time.

*/

sprintf(flash_debug_dir, "flash_debug%d", led->id);

pr_err("[CNYL]: create flash(%d) debug node start!\n", led->id);

flash_kobj = kobject_create_and_add(flash_debug_dir, kernel_kobj);

if (!flash_kobj)

return -ENOMEM;

/* Create the files associated with this kobject */

retval = sysfs_create_group(flash_kobj, &flash_attr_group);

if (retval) {

kobject_put(flash_kobj);

pr_err("[CNYL]: create flash debug node failed.\n");

}

flash_debug_led = led;

pr_err("[CNYL]: create flash(%d) debug node done!\n", led->id);

#endif

}

========================================= 4 ============================================

diff --git a/drivers/media/platform/msm/camera_v2/sensor/ar0543.c b/drivers/media/platform/msm/camera_v2/sensor/ar0543.c

index abaa4bd..e22d0f1 100755

--- a/drivers/media/platform/msm/camera_v2/sensor/ar0543.c

+++ b/drivers/media/platform/msm/camera_v2/sensor/ar0543.c

@@ -16,6 +16,8 @@

#define AR0543_SENSOR_NAME "ar0543"

DEFINE_MSM_MUTEX(ar0543_mut);

+#define SENSOR_KERNEL_DEBUG 1

+

static struct msm_sensor_ctrl_t ar0543_s_ctrl;

static struct msm_sensor_power_setting ar0543_power_setting[] = {

@@ -145,6 +147,108 @@ static struct platform_driver ar0543_platform_driver = {

},

};

+#if SENSOR_KERNEL_DEBUG

+static struct msm_camera_i2c_reg_array reg_w;

+static ssize_t sensor_status_show(struct device *dev,

+ struct device_attribute *attr, char *buf)

+{

+ ssize_t length = 0;

+ length = sprintf(buf, "sensor reg dump:\n"

+ " random read,addr-value:0x%04x - 0x%04x.%s\n",

+ reg_w.reg_addr, reg_w.reg_data,

+ (reg_w.reg_data != 0) ? " " : " (Have you read already?)"

+ );

+/*

+ length = sprintf(buf, "debug Information(version: 20131030):\n"

+ "[R] command: reset the following parameters.\n"

+ "[s] msleep_time:\t%dms (effect in each AF/CAF).\n"

+ "[i] step_interval:\t%d (effect in opening camera).\n"

+ "[l/h] focuser range:\t%d--%d.\n"

+ "[f] flag_debug_foc:\t%d (%s).\n"

+ "[p] set_lens_pos:\t%d (enc_set:0x%x, enc_check:0x%x, diff: 0x%x).\n",

+ tinfo.msleep_time,

+ tinfo.step_interval,

+ tinfo.pos_low, tinfo.pos_high,

+ tinfo.flag_debug_foc, tinfo.flag_debug_foc ? "Debug Mode" : "Normal Mode",

+ tinfo.set_lens_pos, tinfo.enc_set_lens_pos, tinfo.enc_actual_lens_pos, abs_closeloop(tinfo.enc_set_lens_pos-tinfo.enc_actual_lens_pos)

+ );

+*/

+ return length;

+}

+

+

+static ssize_t sensor_attr_set(struct device *dev,

+ struct device_attribute *attr, const char *buf, size_t count)

+{

+ int err;

+ const char *ptr = buf + 1;

+ //u8 ch;

+ //size_t idx = 0;

+ //u32 val = 0;

+ char reg_buf[7], data_buf[7];

+

+ *(reg_buf + 6) = '\0';

+ *(data_buf + 6) = '\0';

+

+ if (count <= 1)

+ return count;

+

+ if (ptr) {

+ switch (buf[0]) {

+ case 'R':

+ break;

+ case 'w'://format: w0xABCD,0xEFGH

+ //if (count <= 1)

+ //return count;

+ memcpy(reg_buf, (buf + 1), 6);

+ memcpy(data_buf, (buf + 8), 6);

+ reg_w.reg_addr = (unsigned short)simple_strtoul(reg_buf, NULL, 16);

+ reg_w.reg_data = (unsigned short)simple_strtoul(data_buf, NULL, 16);

+ pr_info("SENSOR write{0x%04X, 0x%04X}.\n", reg_w.reg_addr, reg_w.reg_data);

+ err = ar0543_s_ctrl.sensor_i2c_client->i2c_func_tbl->i2c_write(ar0543_s_ctrl.sensor_i2c_client, reg_w.reg_addr, reg_w.reg_data, MSM_CAMERA_I2C_WORD_DATA);

+ reg_w.reg_data = 0;

+ if (err)

+ return err;

+ break;

+ case 'r'://format: r0xABCD

+ //if (count <= 1)

+ //return count;

+ memcpy(reg_buf, (buf + 1), 6);

+ reg_w.reg_addr = (unsigned short)simple_strtoul(reg_buf, NULL, 16);

+ pr_info("SENSOR read{0x%04X}.\n", reg_w.reg_addr);

+ err = ar0543_s_ctrl.sensor_i2c_client->i2c_func_tbl->i2c_read(ar0543_s_ctrl.sensor_i2c_client, reg_w.reg_addr, &(reg_w.reg_data), MSM_CAMERA_I2C_WORD_DATA);

+ if (err)

+ return err;

+ break;

+ }

+ }

+

+ return count;

+}

+

+static DEVICE_ATTR(d, 0775, sensor_status_show, sensor_attr_set);

+struct kobject *keobj;

+

+static int drv_sensor_sysfs_init(void /*struct test_info_t *info*/)

+{

+ keobj = kobject_create_and_add("sensor", NULL);

+ if (!keobj) {

+ pr_err("%s subsystem register failed!\n", __func__);

+ return -ENOMEM;

+ }

+

+ if (sysfs_create_file(keobj, &dev_attr_d.attr)) {

+ pr_err("%s sysfs create file failed!\n", __func__);

+ kobject_del(keobj);

+ keobj = NULL;

+ return -ENOMEM;

+ }

+ //ker_info = info;

+

+ return 0;

+}

+#endif

+

static int32_t ar0543_platform_probe(struct platform_device *pdev)

{

int32_t rc = 0;

@@ -152,6 +256,11 @@ static int32_t ar0543_platform_probe(struct platform_device *pdev)

match = of_match_device(ar0543_dt_match, &pdev->dev);

rc = msm_sensor_platform_probe(pdev, match->data);

+

+#if SENSOR_KERNEL_DEBUG

+ drv_sensor_sysfs_init();

+#endif

+

return rc;

}