|
@@ -125,13 +125,13 @@ scmi_device_create(struct device_node *np, struct device *parent, int protocol)
|
|
|
int id, retval;
|
|
|
struct scmi_device *scmi_dev;
|
|
|
|
|
|
- id = ida_simple_get(&scmi_bus_id, 1, 0, GFP_KERNEL);
|
|
|
- if (id < 0)
|
|
|
- return NULL;
|
|
|
-
|
|
|
scmi_dev = kzalloc(sizeof(*scmi_dev), GFP_KERNEL);
|
|
|
if (!scmi_dev)
|
|
|
- goto no_mem;
|
|
|
+ return NULL;
|
|
|
+
|
|
|
+ id = ida_simple_get(&scmi_bus_id, 1, 0, GFP_KERNEL);
|
|
|
+ if (id < 0)
|
|
|
+ goto free_mem;
|
|
|
|
|
|
scmi_dev->id = id;
|
|
|
scmi_dev->protocol_id = protocol;
|
|
@@ -141,13 +141,15 @@ scmi_device_create(struct device_node *np, struct device *parent, int protocol)
|
|
|
dev_set_name(&scmi_dev->dev, "scmi_dev.%d", id);
|
|
|
|
|
|
retval = device_register(&scmi_dev->dev);
|
|
|
- if (!retval)
|
|
|
- return scmi_dev;
|
|
|
+ if (retval)
|
|
|
+ goto put_dev;
|
|
|
|
|
|
+ return scmi_dev;
|
|
|
+put_dev:
|
|
|
put_device(&scmi_dev->dev);
|
|
|
- kfree(scmi_dev);
|
|
|
-no_mem:
|
|
|
ida_simple_remove(&scmi_bus_id, id);
|
|
|
+free_mem:
|
|
|
+ kfree(scmi_dev);
|
|
|
return NULL;
|
|
|
}
|
|
|
|
|
@@ -171,9 +173,9 @@ int scmi_protocol_register(int protocol_id, scmi_prot_init_fn_t fn)
|
|
|
spin_lock(&protocol_lock);
|
|
|
ret = idr_alloc(&scmi_protocols, fn, protocol_id, protocol_id + 1,
|
|
|
GFP_ATOMIC);
|
|
|
+ spin_unlock(&protocol_lock);
|
|
|
if (ret != protocol_id)
|
|
|
pr_err("unable to allocate SCMI idr slot, err %d\n", ret);
|
|
|
- spin_unlock(&protocol_lock);
|
|
|
|
|
|
return ret;
|
|
|
}
|