int kr3dm_acc_start(void) { int result; struct device *dev_t; kr3dmacc_t accels; /* only for test */ result = register_chrdev( KR3DM_MAJOR, "kr3dm", &kr3dm_acc_fops); if (result < 0) { return result; } kr3dm_acc_class = class_create (THIS_MODULE, "KR3DM-dev"); if (IS_ERR(kr3dm_acc_class)) { unregister_chrdev( KR3DM_MAJOR, "kr3dm" ); return PTR_ERR( kr3dm_acc_class ); } dev_t = device_create( kr3dm_acc_class, NULL, MKDEV(KR3DM_MAJOR, 0), "%s", "kr3dm"); if (IS_ERR(dev_t)) { return PTR_ERR(dev_t); } result = i2c_acc_kr3dm_init(); if(result) { return result; } kr3dm_chip_init(); #if DEBUG printk("[KR3DM] read_xyz ==========================\n"); kr3dm_read_accel_xyz( &accels ); printk("[KR3DM] x = %d / y = %d / z = %d\n", accels.x, accels.y, accels.z ); printk("[KR3DM] ======================kr3dm_acc_start Ready for use !!!!! =============\n"); #endif return 0; }
int kr3dm_acc_start(void) { int result; struct device *dev_t; #ifdef SECURITY_HOLE_SUPPORT int err; struct input_dev *input_dev; #endif kr3dmacc_t accels; /* only for test */ result = register_chrdev( KR3DM_MAJOR, "kr3dm", &kr3dm_acc_fops); if (result < 0) { return result; } kr3dm_acc_class = class_create (THIS_MODULE, "KR3DM-dev"); if (IS_ERR(kr3dm_acc_class)) { unregister_chrdev( KR3DM_MAJOR, "kr3dm" ); return PTR_ERR( kr3dm_acc_class ); } dev_t = device_create( kr3dm_acc_class, NULL, MKDEV(KR3DM_MAJOR, 0), "%s", "kr3dm"); if (IS_ERR(dev_t)) { return PTR_ERR(dev_t); } #ifdef SECURITY_HOLE_SUPPORT //mutex_init(&kr3dm.power_lock); /* hrtimer settings. we poll for light values using a timer. */ hrtimer_init(&kr3dm.timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL); kr3dm.acc_poll_delay = ns_to_ktime(240 * NSEC_PER_MSEC); kr3dm.timer.function = kr3dm_timer_func; /* the timer just fires off a work queue request. we need a thread to read the i2c (can be slow and blocking). */ kr3dm.wq = create_singlethread_workqueue("kr3dm_wq"); if (!kr3dm.wq) { err = -ENOMEM; printk("%s: could not create workqueue\n", __func__); goto err_create_workqueue; } /* this is the thread function we run on the work queue */ INIT_WORK(&kr3dm.work_acc, kr3dm_work_func_acc); /* allocate lightsensor-level input_device */ input_dev = input_allocate_device(); if (!input_dev) { printk("%s: could not allocate input device\n", __func__); err = -ENOMEM; goto err_input_allocate_device_light; } input_set_drvdata(input_dev, &kr3dm); input_dev->name = "accel"; set_bit(EV_ABS, input_dev->evbit); /* acceleration x-axis */ input_set_capability(input_dev, EV_ABS, ABS_X); input_set_abs_params(input_dev, ABS_X, -1024, 1024, 0, 0); /* acceleration y-axis */ input_set_capability(input_dev, EV_ABS, ABS_Y); input_set_abs_params(input_dev, ABS_Y, -1024, 1024, 0, 0); /* acceleration z-axis */ input_set_capability(input_dev, EV_ABS, ABS_Z); input_set_abs_params(input_dev, ABS_Z, -1024, 1024, 0, 0); printk("registering lightsensor-level input device\n"); err = input_register_device(input_dev); if (err < 0) { printk("%s: could not register input device\n", __func__); input_free_device(input_dev); goto err_input_register_device_light; } kr3dm.acc_input_dev = input_dev; err = sysfs_create_group(&input_dev->dev.kobj,&acc_attribute_group); if (err) { printk("Creating kr3dm attribute group failed"); goto error_device; } ////////////////////////////////////////////////////////////////////////////// #endif result = i2c_acc_kr3dm_init(); if(result) { return result; } kr3dm_chip_init(); #if DEBUG printk("[KR3DM] read_xyz ==========================\n"); kr3dm_read_accel_xyz( &accels ); printk("[KR3DM] x = %d / y = %d / z = %d\n", accels.x, accels.y, accels.z ); printk("[KR3DM] ======================kr3dm_acc_start Ready for use !!!!! =============\n"); #endif return 0; error_device: sysfs_remove_group(&input_dev->dev.kobj, &acc_attribute_group); err_input_register_device_light: input_unregister_device(kr3dm.acc_input_dev); err_input_allocate_device_light: destroy_workqueue(kr3dm.wq); err_create_workqueue: //mutex_destroy(&kr3dm.power_lock); exit: return err; }