|
@@ -117,7 +117,7 @@ static int _omap_device_activate(struct omap_device *od, u8 ignore_lat)
|
|
|
{
|
|
|
struct timespec a, b, c;
|
|
|
|
|
|
- dev_dbg(&od->pdev.dev, "omap_device: activating\n");
|
|
|
+ dev_dbg(&od->pdev->dev, "omap_device: activating\n");
|
|
|
|
|
|
while (od->pm_lat_level > 0) {
|
|
|
struct omap_device_pm_latency *odpl;
|
|
@@ -141,7 +141,7 @@ static int _omap_device_activate(struct omap_device *od, u8 ignore_lat)
|
|
|
c = timespec_sub(b, a);
|
|
|
act_lat = timespec_to_ns(&c);
|
|
|
|
|
|
- dev_dbg(&od->pdev.dev,
|
|
|
+ dev_dbg(&od->pdev->dev,
|
|
|
"omap_device: pm_lat %d: activate: elapsed time "
|
|
|
"%llu nsec\n", od->pm_lat_level, act_lat);
|
|
|
|
|
@@ -149,12 +149,12 @@ static int _omap_device_activate(struct omap_device *od, u8 ignore_lat)
|
|
|
odpl->activate_lat_worst = act_lat;
|
|
|
if (odpl->flags & OMAP_DEVICE_LATENCY_AUTO_ADJUST) {
|
|
|
odpl->activate_lat = act_lat;
|
|
|
- dev_dbg(&od->pdev.dev,
|
|
|
+ dev_dbg(&od->pdev->dev,
|
|
|
"new worst case activate latency "
|
|
|
"%d: %llu\n",
|
|
|
od->pm_lat_level, act_lat);
|
|
|
} else
|
|
|
- dev_warn(&od->pdev.dev,
|
|
|
+ dev_warn(&od->pdev->dev,
|
|
|
"activate latency %d "
|
|
|
"higher than exptected. (%llu > %d)\n",
|
|
|
od->pm_lat_level, act_lat,
|
|
@@ -185,7 +185,7 @@ static int _omap_device_deactivate(struct omap_device *od, u8 ignore_lat)
|
|
|
{
|
|
|
struct timespec a, b, c;
|
|
|
|
|
|
- dev_dbg(&od->pdev.dev, "omap_device: deactivating\n");
|
|
|
+ dev_dbg(&od->pdev->dev, "omap_device: deactivating\n");
|
|
|
|
|
|
while (od->pm_lat_level < od->pm_lats_cnt) {
|
|
|
struct omap_device_pm_latency *odpl;
|
|
@@ -208,7 +208,7 @@ static int _omap_device_deactivate(struct omap_device *od, u8 ignore_lat)
|
|
|
c = timespec_sub(b, a);
|
|
|
deact_lat = timespec_to_ns(&c);
|
|
|
|
|
|
- dev_dbg(&od->pdev.dev,
|
|
|
+ dev_dbg(&od->pdev->dev,
|
|
|
"omap_device: pm_lat %d: deactivate: elapsed time "
|
|
|
"%llu nsec\n", od->pm_lat_level, deact_lat);
|
|
|
|
|
@@ -216,12 +216,12 @@ static int _omap_device_deactivate(struct omap_device *od, u8 ignore_lat)
|
|
|
odpl->deactivate_lat_worst = deact_lat;
|
|
|
if (odpl->flags & OMAP_DEVICE_LATENCY_AUTO_ADJUST) {
|
|
|
odpl->deactivate_lat = deact_lat;
|
|
|
- dev_dbg(&od->pdev.dev,
|
|
|
+ dev_dbg(&od->pdev->dev,
|
|
|
"new worst case deactivate latency "
|
|
|
"%d: %llu\n",
|
|
|
od->pm_lat_level, deact_lat);
|
|
|
} else
|
|
|
- dev_warn(&od->pdev.dev,
|
|
|
+ dev_warn(&od->pdev->dev,
|
|
|
"deactivate latency %d "
|
|
|
"higher than exptected. (%llu > %d)\n",
|
|
|
od->pm_lat_level, deact_lat,
|
|
@@ -245,11 +245,11 @@ static void _add_clkdev(struct omap_device *od, const char *clk_alias,
|
|
|
if (!clk_alias || !clk_name)
|
|
|
return;
|
|
|
|
|
|
- dev_dbg(&od->pdev.dev, "Creating %s -> %s\n", clk_alias, clk_name);
|
|
|
+ dev_dbg(&od->pdev->dev, "Creating %s -> %s\n", clk_alias, clk_name);
|
|
|
|
|
|
- r = clk_get_sys(dev_name(&od->pdev.dev), clk_alias);
|
|
|
+ r = clk_get_sys(dev_name(&od->pdev->dev), clk_alias);
|
|
|
if (!IS_ERR(r)) {
|
|
|
- dev_warn(&od->pdev.dev,
|
|
|
+ dev_warn(&od->pdev->dev,
|
|
|
"alias %s already exists\n", clk_alias);
|
|
|
clk_put(r);
|
|
|
return;
|
|
@@ -257,14 +257,14 @@ static void _add_clkdev(struct omap_device *od, const char *clk_alias,
|
|
|
|
|
|
r = omap_clk_get_by_name(clk_name);
|
|
|
if (IS_ERR(r)) {
|
|
|
- dev_err(&od->pdev.dev,
|
|
|
+ dev_err(&od->pdev->dev,
|
|
|
"omap_clk_get_by_name for %s failed\n", clk_name);
|
|
|
return;
|
|
|
}
|
|
|
|
|
|
- l = clkdev_alloc(r, clk_alias, dev_name(&od->pdev.dev));
|
|
|
+ l = clkdev_alloc(r, clk_alias, dev_name(&od->pdev->dev));
|
|
|
if (!l) {
|
|
|
- dev_err(&od->pdev.dev,
|
|
|
+ dev_err(&od->pdev->dev,
|
|
|
"clkdev_alloc for %s failed\n", clk_alias);
|
|
|
return;
|
|
|
}
|
|
@@ -351,7 +351,7 @@ static int omap_device_count_resources(struct omap_device *od)
|
|
|
c += omap_hwmod_count_resources(od->hwmods[i]);
|
|
|
|
|
|
pr_debug("omap_device: %s: counted %d total resources across %d "
|
|
|
- "hwmods\n", od->pdev.name, c, od->hwmods_cnt);
|
|
|
+ "hwmods\n", od->pdev->name, c, od->hwmods_cnt);
|
|
|
|
|
|
return c;
|
|
|
}
|
|
@@ -445,8 +445,8 @@ struct platform_device *omap_device_build_ss(const char *pdev_name, int pdev_id,
|
|
|
int pm_lats_cnt, int is_early_device)
|
|
|
{
|
|
|
int ret = -ENOMEM;
|
|
|
+ struct platform_device *pdev;
|
|
|
struct omap_device *od;
|
|
|
- char *pdev_name2;
|
|
|
struct resource *res = NULL;
|
|
|
int i, res_count;
|
|
|
struct omap_hwmod **hwmods;
|
|
@@ -457,72 +457,76 @@ struct platform_device *omap_device_build_ss(const char *pdev_name, int pdev_id,
|
|
|
if (!pdata && pdata_len > 0)
|
|
|
return ERR_PTR(-EINVAL);
|
|
|
|
|
|
+ pdev = platform_device_alloc(pdev_name, pdev_id);
|
|
|
+ if (!pdev) {
|
|
|
+ ret = -ENOMEM;
|
|
|
+ goto odbs_exit;
|
|
|
+ }
|
|
|
+
|
|
|
pr_debug("omap_device: %s: building with %d hwmods\n", pdev_name,
|
|
|
oh_cnt);
|
|
|
|
|
|
od = kzalloc(sizeof(struct omap_device), GFP_KERNEL);
|
|
|
- if (!od)
|
|
|
- return ERR_PTR(-ENOMEM);
|
|
|
-
|
|
|
+ if (!od) {
|
|
|
+ ret = -ENOMEM;
|
|
|
+ goto odbs_exit1;
|
|
|
+ }
|
|
|
od->hwmods_cnt = oh_cnt;
|
|
|
|
|
|
hwmods = kzalloc(sizeof(struct omap_hwmod *) * oh_cnt,
|
|
|
GFP_KERNEL);
|
|
|
if (!hwmods)
|
|
|
- goto odbs_exit1;
|
|
|
+ goto odbs_exit2;
|
|
|
|
|
|
memcpy(hwmods, ohs, sizeof(struct omap_hwmod *) * oh_cnt);
|
|
|
od->hwmods = hwmods;
|
|
|
-
|
|
|
- pdev_name2 = kzalloc(strlen(pdev_name) + 1, GFP_KERNEL);
|
|
|
- if (!pdev_name2)
|
|
|
- goto odbs_exit2;
|
|
|
- strcpy(pdev_name2, pdev_name);
|
|
|
-
|
|
|
- od->pdev.name = pdev_name2;
|
|
|
- od->pdev.id = pdev_id;
|
|
|
+ od->pdev = pdev;
|
|
|
|
|
|
res_count = omap_device_count_resources(od);
|
|
|
if (res_count > 0) {
|
|
|
res = kzalloc(sizeof(struct resource) * res_count, GFP_KERNEL);
|
|
|
if (!res)
|
|
|
goto odbs_exit3;
|
|
|
- }
|
|
|
- omap_device_fill_resources(od, res);
|
|
|
|
|
|
- od->pdev.num_resources = res_count;
|
|
|
- od->pdev.resource = res;
|
|
|
+ omap_device_fill_resources(od, res);
|
|
|
|
|
|
- ret = platform_device_add_data(&od->pdev, pdata, pdata_len);
|
|
|
+ ret = platform_device_add_resources(pdev, res, res_count);
|
|
|
+ kfree(res);
|
|
|
+
|
|
|
+ if (ret)
|
|
|
+ goto odbs_exit3;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = platform_device_add_data(pdev, pdata, pdata_len);
|
|
|
if (ret)
|
|
|
- goto odbs_exit4;
|
|
|
+ goto odbs_exit3;
|
|
|
|
|
|
- od->pm_lats = pm_lats;
|
|
|
- od->pm_lats_cnt = pm_lats_cnt;
|
|
|
+ pdev->archdata.od = od;
|
|
|
|
|
|
if (is_early_device)
|
|
|
- ret = omap_early_device_register(&od->pdev);
|
|
|
+ ret = omap_early_device_register(pdev);
|
|
|
else
|
|
|
- ret = omap_device_register(&od->pdev);
|
|
|
+ ret = omap_device_register(pdev);
|
|
|
+ if (ret)
|
|
|
+ goto odbs_exit3;
|
|
|
+
|
|
|
+ od->pm_lats = pm_lats;
|
|
|
+ od->pm_lats_cnt = pm_lats_cnt;
|
|
|
|
|
|
for (i = 0; i < oh_cnt; i++) {
|
|
|
hwmods[i]->od = od;
|
|
|
_add_hwmod_clocks_clkdev(od, hwmods[i]);
|
|
|
}
|
|
|
|
|
|
- if (ret)
|
|
|
- goto odbs_exit4;
|
|
|
-
|
|
|
- return &od->pdev;
|
|
|
+ return pdev;
|
|
|
|
|
|
-odbs_exit4:
|
|
|
- kfree(res);
|
|
|
odbs_exit3:
|
|
|
- kfree(pdev_name2);
|
|
|
-odbs_exit2:
|
|
|
kfree(hwmods);
|
|
|
-odbs_exit1:
|
|
|
+odbs_exit2:
|
|
|
kfree(od);
|
|
|
+odbs_exit1:
|
|
|
+ platform_device_put(pdev);
|
|
|
+odbs_exit:
|
|
|
|
|
|
pr_err("omap_device: %s: build failed (%d)\n", pdev_name, ret);
|
|
|
|
|
@@ -644,7 +648,7 @@ static int omap_device_register(struct platform_device *pdev)
|
|
|
|
|
|
pdev->dev.parent = &omap_device_parent;
|
|
|
pdev->dev.pm_domain = &omap_device_pm_domain;
|
|
|
- return platform_device_register(pdev);
|
|
|
+ return platform_device_add(pdev);
|
|
|
}
|
|
|
|
|
|
|