#include <sys/archsystm.h>
#include <sys/types.h>
#include <sys/dditypes.h>
#include <sys/ddi_impldefs.h>
#include <sys/sunddi.h>
#include <sys/cpu.h>
int
i_ddi_bus_map(dev_info_t *dip, dev_info_t *rdip, ddi_map_req_t *mp,
off_t offset, off_t len, caddr_t *vaddrp)
{
struct regspec tmp_reg, *rp;
ddi_map_req_t mr = *mp;
int error;
mp = &mr;
if (mp->map_type == DDI_MT_RNUMBER) {
int rnumber = mp->map_obj.rnumber;
#ifdef DDI_MAP_DEBUG
static char *out_of_range =
"i_ddi_bus_map: Out of range rnumber <%d>, device <%s>";
#endif
rp = i_ddi_rnumber_to_regspec(rdip, rnumber);
if (rp == (struct regspec *)0) {
#ifdef DDI_MAP_DEBUG
cmn_err(CE_WARN, out_of_range, rnumber,
ddi_get_name(rdip));
#endif
return (DDI_ME_RNUMBER_RANGE);
}
mp->map_type = DDI_MT_REGSPEC;
mp->map_obj.rp = rp;
}
tmp_reg = *(mp->map_obj.rp);
rp = mp->map_obj.rp = &tmp_reg;
#ifdef DDI_MAP_DEBUG
cmn_err(CE_CONT,
"i_ddi_bus_map: <%s,%s> <0x%x, 0x%x, 0x%d> "
"offset %d len %d handle 0x%x\n",
ddi_get_name(dip), ddi_get_name(rdip),
rp->regspec_bustype, rp->regspec_addr, rp->regspec_size,
offset, len, mp->map_handlep);
#endif
if (rp->regspec_bustype > 1 && rp->regspec_addr != 0) {
cmn_err(CE_WARN, "<%s,%s>: invalid register spec"
" <0x%x, 0x%x, 0x%x>\n", ddi_get_name(dip),
ddi_get_name(rdip), rp->regspec_bustype,
rp->regspec_addr, rp->regspec_size);
return (DDI_ME_INVAL);
}
if (rp->regspec_bustype > 1 && rp->regspec_addr == 0) {
rp->regspec_bustype += (uint_t)offset;
} else {
rp->regspec_addr += (uint_t)offset;
}
if (len != 0)
rp->regspec_size = (uint_t)len;
#ifdef DDI_MAP_DEBUG
cmn_err(CE_CONT,
" <%s,%s> <0x%x, 0x%x, 0x%d> "
"offset %d len %d\n",
ddi_get_name(dip), ddi_get_name(rdip),
rp->regspec_bustype, rp->regspec_addr, rp->regspec_size,
offset, len);
#endif
#ifdef DDI_MAP_DEBUG
ddi_map_debug("applying range of parent <%s> to child <%s>...\n",
ddi_get_name(dip), ddi_get_name(rdip));
#endif
if ((error = i_ddi_apply_range(dip, rdip, mp->map_obj.rp)) != 0)
return (error);
return (ddi_map(dip, mp, (off_t)0, (off_t)0, vaddrp));
}
struct regspec *
i_ddi_rnumber_to_regspec(dev_info_t *dip, int rnumber)
{
if (rnumber >= sparc_pd_getnreg(DEVI(dip)))
return ((struct regspec *)0);
return (sparc_pd_getreg(DEVI(dip), rnumber));
}
static int
reg_is_enclosed_in_range(struct regspec *rp, struct rangespec *rangep)
{
if (rp->regspec_bustype != rangep->rng_cbustype)
return (0);
if (rp->regspec_addr < rangep->rng_coffset)
return (0);
if (rangep->rng_size == 0)
return (1);
if ((rp->regspec_addr + rp->regspec_size - 1) <=
(rangep->rng_coffset + rangep->rng_size - 1))
return (1);
return (0);
}
int
i_ddi_apply_range(dev_info_t *dp, dev_info_t *rdip, struct regspec *rp)
{
int nrange, b;
struct rangespec *rangep;
static char *out_of_range =
"Out of range register specification from device node <%s>\n";
nrange = sparc_pd_getnrng(dp);
if (nrange == 0) {
#ifdef DDI_MAP_DEBUG
ddi_map_debug(" No range.\n");
#endif
return (0);
}
for (b = 0, rangep = sparc_pd_getrng(dp, 0); b < nrange; ++b, ++rangep)
if (reg_is_enclosed_in_range(rp, rangep))
break;
if (b == nrange) {
cmn_err(CE_WARN, out_of_range, ddi_get_name(rdip));
return (DDI_ME_REGSPEC_RANGE);
}
#ifdef DDI_MAP_DEBUG
ddi_map_debug(" Input: %x.%x.%x\n", rp->regspec_bustype,
rp->regspec_addr, rp->regspec_size);
ddi_map_debug(" Range: %x.%x %x.%x %x\n",
rangep->rng_cbustype, rangep->rng_coffset,
rangep->rng_bustype, rangep->rng_offset, rangep->rng_size);
#endif
rp->regspec_bustype = rangep->rng_bustype;
rp->regspec_addr += rangep->rng_offset - rangep->rng_coffset;
#ifdef DDI_MAP_DEBUG
ddi_map_debug(" Return: %x.%x.%x\n", rp->regspec_bustype,
rp->regspec_addr, rp->regspec_size);
#endif
return (0);
}
int
i_ddi_map_fault(dev_info_t *dip, dev_info_t *rdip,
struct hat *hat, struct seg *seg, caddr_t addr,
struct devpage *dp, pfn_t pfn, uint_t prot, uint_t lock)
{
dev_info_t *pdip;
if (dip == NULL)
return (DDI_FAILURE);
pdip = (dev_info_t *)DEVI(dip)->devi_bus_map_fault;
return ((*(DEVI(pdip)->devi_ops->devo_bus_ops->bus_map_fault))(pdip,
rdip, hat, seg, addr, dp, pfn, prot, lock));
}
int
impl_ddi_prop_int_from_prom(uchar_t *intp, int n)
{
int i = 0;
ASSERT(n > 0 && n <= 4);
intp += n;
while (n-- > 0) {
i = (i << 8) | *(--intp);
}
return (i);
}
int drv_usec_coarse_timing = 0;
void
drv_usecwait(clock_t count)
{
int tens = 0;
extern int gethrtime_hires;
if (gethrtime_hires) {
hrtime_t start, end;
hrtime_t waittime;
if (drv_usec_coarse_timing) {
waittime = ((count > 10) ?
(((hrtime_t)count / 10) + 1) : 1) *
10 * (NANOSEC / MICROSEC);
} else {
waittime = (hrtime_t)count * (NANOSEC / MICROSEC);
}
start = end = gethrtime();
while ((end - start) < waittime) {
SMT_PAUSE();
end = gethrtime();
}
return;
}
if (count > 10)
tens = count/10;
tens++;
while (tens > 0) {
tenmicrosec();
tens--;
}
}