return 0;
}
-int rmi_register_function(struct rmi_function *fn)
+struct rmi_function *rmi_alloc_function(struct rmi_device *rmi_dev, u8 id)
{
- struct rmi_device *rmi_dev = fn->rmi_dev;
- int error;
+ struct rmi_driver_data *data = dev_get_drvdata(&rmi_dev->dev);
+ struct rmi_function *fn;
+
+ fn = kzalloc(sizeof(*fn) +
+ BITS_TO_LONGS(data->irq_count) * sizeof(unsigned long),
+ GFP_KERNEL);
+ if (!fn)
+ return NULL;
device_initialize(&fn->dev);
- dev_set_name(&fn->dev, "%s.fn%02x",
- dev_name(&rmi_dev->dev), fn->fd.function_number);
+ dev_set_name(&fn->dev, "%s.fn%02x", dev_name(&rmi_dev->dev), id);
fn->dev.parent = &rmi_dev->dev;
fn->dev.type = &rmi_function_type;
fn->dev.bus = &rmi_bus_type;
+ fn->rmi_dev = rmi_dev;
+
+ return fn;
+}
+
+int rmi_register_function(struct rmi_function *fn)
+{
+ struct rmi_device *rmi_dev = fn->rmi_dev;
+ int error;
error = device_add(&fn->dev);
if (error) {
dev_err(&rmi_dev->dev,
- "Failed device_register function device %s\n",
+ "Failed to register function device %s\n",
dev_name(&fn->dev));
- goto err_put_device;
+ return error;
}
rmi_dbg(RMI_DEBUG_CORE, &rmi_dev->dev, "Registered F%02X.\n",
fn->fd.function_number);
return 0;
-
-err_put_device:
- put_device(&fn->dev);
- return error;
}
void rmi_unregister_function(struct rmi_function *fn)
bool rmi_is_function_device(struct device *dev);
+struct rmi_function *rmi_alloc_function(struct rmi_device *rmi_dev, u8 id);
int __must_check rmi_register_function(struct rmi_function *);
void rmi_unregister_function(struct rmi_function *);
rmi_dbg(RMI_DEBUG_CORE, dev, "Initializing F%02X.\n",
pdt->function_number);
- fn = kzalloc(sizeof(struct rmi_function) +
- BITS_TO_LONGS(data->irq_count) * sizeof(unsigned long),
- GFP_KERNEL);
+ fn = rmi_alloc_function(rmi_dev, pdt->function_number);
if (!fn) {
dev_err(dev, "Failed to allocate memory for F%02X\n",
pdt->function_number);
INIT_LIST_HEAD(&fn->node);
rmi_driver_copy_pdt_to_fd(pdt, &fn->fd);
- fn->rmi_dev = rmi_dev;
-
fn->num_of_irqs = pdt->interrupt_source_count;
fn->irq_pos = *current_irq_count;
*current_irq_count += fn->num_of_irqs;
set_bit(fn->irq_pos + i, fn->irq_mask);
error = rmi_register_function(fn);
- if (error)
+ if (error) {
+ put_device(&fn->dev);
return error;
+ }
if (pdt->function_number == 0x01)
data->f01_container = fn;