Skip to content

Commit

Permalink
---
Browse files Browse the repository at this point in the history
yaml
---
r: 273335
b: refs/heads/master
c: c97f6dd
h: refs/heads/master
i:
  273333: 6845cfb
  273331: ff9dc11
  273327: 66fddfd
v: v3
  • Loading branch information
Ohad Ben-Cohen committed Sep 21, 2011
1 parent f3524e7 commit 9446cba
Show file tree
Hide file tree
Showing 2 changed files with 18 additions and 35 deletions.
2 changes: 1 addition & 1 deletion [refs]
Original file line number Diff line number Diff line change
@@ -1,2 +1,2 @@
---
refs/heads/master: e467b6421435f467e274d4f25d62900e1e0e4286
refs/heads/master: c97f6dd0fe21dfd658c59c144a1b7fd5d8db04ac
51 changes: 17 additions & 34 deletions trunk/drivers/hwspinlock/omap_hwspinlock.c
Original file line number Diff line number Diff line change
Expand Up @@ -52,6 +52,7 @@ struct omap_hwspinlock {
struct omap_hwspinlock_state {
int num_locks; /* Total number of locks in system */
void __iomem *io_base; /* Mapped base address */
struct omap_hwspinlock lock[0]; /* Array of 'num_locks' locks */
};

static int omap_hwspinlock_trylock(struct hwspinlock *lock)
Expand Down Expand Up @@ -95,7 +96,6 @@ static int __devinit omap_hwspinlock_probe(struct platform_device *pdev)
{
struct omap_hwspinlock *omap_lock;
struct omap_hwspinlock_state *state;
struct hwspinlock *lock;
struct resource *res;
void __iomem *io_base;
int i, ret;
Expand All @@ -104,15 +104,9 @@ static int __devinit omap_hwspinlock_probe(struct platform_device *pdev)
if (!res)
return -ENODEV;

state = kzalloc(sizeof(*state), GFP_KERNEL);
if (!state)
return -ENOMEM;

io_base = ioremap(res->start, resource_size(res));
if (!io_base) {
ret = -ENOMEM;
goto free_state;
}
if (!io_base)
return -ENOMEM;

/* Determine number of locks */
i = readl(io_base + SYSSTATUS_OFFSET);
Expand All @@ -124,7 +118,15 @@ static int __devinit omap_hwspinlock_probe(struct platform_device *pdev)
goto iounmap_base;
}

state->num_locks = i * 32;
i *= 32; /* actual number of locks in this device */

state = kzalloc(sizeof(*state) + i * sizeof(*omap_lock), GFP_KERNEL);
if (!state) {
ret = -ENOMEM;
goto iounmap_base;
}

state->num_locks = i;
state->io_base = io_base;

platform_set_drvdata(pdev, state);
Expand All @@ -136,50 +138,34 @@ static int __devinit omap_hwspinlock_probe(struct platform_device *pdev)
pm_runtime_enable(&pdev->dev);

for (i = 0; i < state->num_locks; i++) {
omap_lock = kzalloc(sizeof(*omap_lock), GFP_KERNEL);
if (!omap_lock) {
ret = -ENOMEM;
goto free_locks;
}
omap_lock = &state->lock[i];

omap_lock->lock.dev = &pdev->dev;
omap_lock->lock.id = i;
omap_lock->lock.ops = &omap_hwspinlock_ops;
omap_lock->addr = io_base + LOCK_BASE_OFFSET + sizeof(u32) * i;

ret = hwspin_lock_register(&omap_lock->lock);
if (ret) {
kfree(omap_lock);
if (ret)
goto free_locks;
}
}

return 0;

free_locks:
while (--i >= 0) {
lock = hwspin_lock_unregister(i);
/* this should't happen, but let's give our best effort */
if (!lock) {
dev_err(&pdev->dev, "%s: cleanups failed\n", __func__);
continue;
}
omap_lock = to_omap_hwspinlock(lock);
kfree(omap_lock);
}
while (--i >= 0)
hwspin_lock_unregister(i);
pm_runtime_disable(&pdev->dev);
kfree(state);
iounmap_base:
iounmap(io_base);
free_state:
kfree(state);
return ret;
}

static int omap_hwspinlock_remove(struct platform_device *pdev)
{
struct omap_hwspinlock_state *state = platform_get_drvdata(pdev);
struct hwspinlock *lock;
struct omap_hwspinlock *omap_lock;
int i;

for (i = 0; i < state->num_locks; i++) {
Expand All @@ -190,9 +176,6 @@ static int omap_hwspinlock_remove(struct platform_device *pdev)
dev_err(&pdev->dev, "%s: failed on %d\n", __func__, i);
return -EBUSY;
}

omap_lock = to_omap_hwspinlock(lock);
kfree(omap_lock);
}

pm_runtime_disable(&pdev->dev);
Expand Down

0 comments on commit 9446cba

Please sign in to comment.