72 lines
1.6 KiB
C
72 lines
1.6 KiB
C
/*
|
|
* OMAP2/3 CM module functions
|
|
*
|
|
* Copyright (C) 2009 Nokia Corporation
|
|
* Paul Walmsley
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/types.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/spinlock.h>
|
|
#include <linux/list.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/err.h>
|
|
#include <linux/io.h>
|
|
|
|
#include <asm/atomic.h>
|
|
|
|
#include <plat/common.h>
|
|
|
|
#include "cm.h"
|
|
#include "cm-regbits-24xx.h"
|
|
#include "cm-regbits-34xx.h"
|
|
|
|
/* MAX_MODULE_READY_TIME: max milliseconds for module to leave idle */
|
|
#define MAX_MODULE_READY_TIME 20000
|
|
|
|
static const u8 cm_idlest_offs[] = {
|
|
CM_IDLEST1, CM_IDLEST2, OMAP2430_CM_IDLEST3
|
|
};
|
|
|
|
/**
|
|
* omap2_cm_wait_idlest_ready - wait for a module to leave idle or standby
|
|
* @prcm_mod: PRCM module offset
|
|
* @idlest_id: CM_IDLESTx register ID (i.e., x = 1, 2, 3)
|
|
* @idlest_shift: shift of the bit in the CM_IDLEST* register to check
|
|
*
|
|
* XXX document
|
|
*/
|
|
int omap2_cm_wait_module_ready(s16 prcm_mod, u8 idlest_id, u8 idlest_shift)
|
|
{
|
|
int ena = 0, i = 0;
|
|
u8 cm_idlest_reg;
|
|
u32 mask;
|
|
|
|
if (!idlest_id || (idlest_id > ARRAY_SIZE(cm_idlest_offs)))
|
|
return -EINVAL;
|
|
|
|
cm_idlest_reg = cm_idlest_offs[idlest_id - 1];
|
|
|
|
if (cpu_is_omap24xx())
|
|
ena = idlest_shift;
|
|
else if (cpu_is_omap34xx())
|
|
ena = 0;
|
|
else
|
|
BUG();
|
|
|
|
mask = 1 << idlest_shift;
|
|
|
|
/* XXX should be OMAP2 CM */
|
|
omap_test_timeout(((cm_read_mod_reg(prcm_mod, cm_idlest_reg) & mask) == ena),
|
|
MAX_MODULE_READY_TIME, i);
|
|
|
|
return (i < MAX_MODULE_READY_TIME) ? 0 : -EBUSY;
|
|
}
|
|
|