#include <sys/types.h>
#include <sys/kstat.h>
#include <sys/param.h>
#include <sys/stack.h>
#include <sys/regset.h>
#include <sys/thread.h>
#include <sys/proc.h>
#include <sys/procfs_isa.h>
#include <sys/kmem.h>
#include <sys/cpuvar.h>
#include <sys/systm.h>
#include <sys/machpcb.h>
#include <sys/machasi.h>
#include <sys/vis.h>
#include <sys/fpu/fpusystm.h>
#include <sys/cpu_module.h>
#include <sys/privregs.h>
#include <sys/archsystm.h>
#include <sys/atomic.h>
#include <sys/cmn_err.h>
#include <sys/time.h>
#include <sys/clock.h>
#include <sys/cmp.h>
#include <sys/platform_module.h>
#include <sys/bl.h>
#include <sys/nvpair.h>
#include <sys/kdi_impl.h>
#include <sys/machsystm.h>
#include <sys/sysmacros.h>
#include <sys/promif.h>
#include <sys/pool_pset.h>
#include <sys/mem.h>
#include <sys/dumphdr.h>
#include <vm/seg_kmem.h>
#include <sys/hold_page.h>
#include <sys/cpu.h>
#include <sys/ivintr.h>
#include <sys/clock_impl.h>
#include <sys/machclock.h>
int maxphys = MMU_PAGESIZE * 16;
int klustsize = MMU_PAGESIZE * 16;
caddr_t
thread_stk_init(caddr_t stk)
{
kfpu_t *fp;
ulong_t align;
stk -= SA(sizeof (kfpu_t) + GSR_SIZE);
align = (uintptr_t)stk & 0x3f;
stk -= align;
fp = (kfpu_t *)stk;
fp->fpu_fprs = 0;
stk -= SA(MINFRAME);
return (stk);
}
#define WIN32_SIZE (MAXWIN * sizeof (struct rwindow32))
#define WIN64_SIZE (MAXWIN * sizeof (struct rwindow64))
kmem_cache_t *wbuf32_cache;
kmem_cache_t *wbuf64_cache;
void
lwp_stk_cache_init(void)
{
wbuf32_cache = kmem_cache_create("wbuf32_cache", WIN32_SIZE,
0, NULL, NULL, NULL, NULL, static_arena, KMC_NOHASH);
wbuf64_cache = kmem_cache_create("wbuf64_cache", WIN64_SIZE,
0, NULL, NULL, NULL, NULL, static_arena, KMC_NOHASH);
}
caddr_t
lwp_stk_init(klwp_t *lwp, caddr_t stk)
{
struct machpcb *mpcb;
kfpu_t *fp;
uintptr_t aln;
stk -= SA(sizeof (kfpu_t) + GSR_SIZE);
aln = (uintptr_t)stk & 0x3F;
stk -= aln;
fp = (kfpu_t *)stk;
stk -= SA(sizeof (struct machpcb));
mpcb = (struct machpcb *)stk;
bzero(mpcb, sizeof (struct machpcb));
bzero(fp, sizeof (kfpu_t) + GSR_SIZE);
lwp->lwp_regs = (void *)&mpcb->mpcb_regs;
lwp->lwp_fpu = (void *)fp;
mpcb->mpcb_fpu = fp;
mpcb->mpcb_fpu->fpu_q = mpcb->mpcb_fpu_q;
mpcb->mpcb_thread = lwp->lwp_thread;
mpcb->mpcb_wbcnt = 0;
if (lwp->lwp_procp->p_model == DATAMODEL_ILP32) {
mpcb->mpcb_wstate = WSTATE_USER32;
mpcb->mpcb_wbuf = kmem_cache_alloc(wbuf32_cache, KM_SLEEP);
} else {
mpcb->mpcb_wstate = WSTATE_USER64;
mpcb->mpcb_wbuf = kmem_cache_alloc(wbuf64_cache, KM_SLEEP);
}
ASSERT(((uintptr_t)mpcb->mpcb_wbuf & 7) == 0);
mpcb->mpcb_wbuf_pa = va_to_pa(mpcb->mpcb_wbuf);
mpcb->mpcb_pa = va_to_pa(mpcb);
return (stk);
}
void
lwp_stk_fini(klwp_t *lwp)
{
struct machpcb *mpcb = lwptompcb(lwp);
mpcb->mpcb_wbcnt = 0;
if (mpcb->mpcb_wstate == WSTATE_USER32)
kmem_cache_free(wbuf32_cache, mpcb->mpcb_wbuf);
else
kmem_cache_free(wbuf64_cache, mpcb->mpcb_wbuf);
mpcb->mpcb_wbuf = NULL;
mpcb->mpcb_wbuf_pa = -1;
}
void
lwp_fp_init(klwp_t *lwp)
{
}
void
lwp_forkregs(klwp_t *lwp, klwp_t *clwp)
{
kthread_t *t, *pt = lwptot(lwp);
struct machpcb *mpcb = lwptompcb(clwp);
struct machpcb *pmpcb = lwptompcb(lwp);
kfpu_t *fp, *pfp = lwptofpu(lwp);
caddr_t wbuf;
uint_t wstate;
t = mpcb->mpcb_thread;
fp = mpcb->mpcb_fpu;
wbuf = mpcb->mpcb_wbuf;
wstate = mpcb->mpcb_wstate;
bcopy(lwp->lwp_regs, clwp->lwp_regs, sizeof (struct machpcb) - REGOFF);
mpcb->mpcb_thread = t;
mpcb->mpcb_fpu = fp;
fp->fpu_q = mpcb->mpcb_fpu_q;
if (mpcb->mpcb_wstate != wstate) {
if (wstate == WSTATE_USER32) {
kmem_cache_free(wbuf32_cache, wbuf);
wbuf = kmem_cache_alloc(wbuf64_cache, KM_SLEEP);
wstate = WSTATE_USER64;
} else {
kmem_cache_free(wbuf64_cache, wbuf);
wbuf = kmem_cache_alloc(wbuf32_cache, KM_SLEEP);
wstate = WSTATE_USER32;
}
}
mpcb->mpcb_pa = va_to_pa(mpcb);
mpcb->mpcb_wbuf = wbuf;
mpcb->mpcb_wbuf_pa = va_to_pa(wbuf);
ASSERT(mpcb->mpcb_wstate == wstate);
if (mpcb->mpcb_wbcnt != 0) {
bcopy(pmpcb->mpcb_wbuf, mpcb->mpcb_wbuf,
mpcb->mpcb_wbcnt * ((mpcb->mpcb_wstate == WSTATE_USER32) ?
sizeof (struct rwindow32) : sizeof (struct rwindow64)));
}
if (pt == curthread)
pfp->fpu_fprs = _fp_read_fprs();
if ((pfp->fpu_en) || (pfp->fpu_fprs & FPRS_FEF)) {
if (pt == curthread && fpu_exists) {
save_gsr(clwp->lwp_fpu);
} else {
uint64_t gsr;
gsr = get_gsr(lwp->lwp_fpu);
set_gsr(gsr, clwp->lwp_fpu);
}
fp_fork(lwp, clwp);
}
}
void
lwp_freeregs(klwp_t *lwp, int isexec)
{
kfpu_t *fp = lwptofpu(lwp);
if (lwptot(lwp) == curthread)
fp->fpu_fprs = _fp_read_fprs();
if ((fp->fpu_en) || (fp->fpu_fprs & FPRS_FEF))
fp_free(fp, isexec);
}
void
lwp_attach_brand_hdlrs(klwp_t *lwp)
{}
void
lwp_detach_brand_hdlrs(klwp_t *lwp)
{}
void
xregs_getgfiller(klwp_id_t lwp, caddr_t xrp)
{
}
void
xregs_getfpfiller(klwp_id_t lwp, caddr_t xrp)
{
prxregset_t *xregs = (prxregset_t *)xrp;
kfpu_t *fp = lwptofpu(lwp);
uint32_t fprs = (FPRS_FEF|FPRS_DU|FPRS_DL);
uint64_t gsr;
kpreempt_disable();
if (ttolwp(curthread) == lwp && fpu_exists) {
fp->fpu_fprs = _fp_read_fprs();
if ((fp->fpu_fprs & FPRS_FEF) != FPRS_FEF) {
_fp_write_fprs(fprs);
fp->fpu_fprs = (V9_FPU_FPRS_TYPE)fprs;
}
save_gsr(fp);
}
gsr = get_gsr(fp);
kpreempt_enable();
PRXREG_GSR(xregs) = gsr;
}
void
xregs_setgfiller(klwp_id_t lwp, caddr_t xrp)
{
}
void
xregs_setfpfiller(klwp_id_t lwp, caddr_t xrp)
{
prxregset_t *xregs = (prxregset_t *)xrp;
kfpu_t *fp = lwptofpu(lwp);
uint32_t fprs = (FPRS_FEF|FPRS_DU|FPRS_DL);
uint64_t gsr = PRXREG_GSR(xregs);
kpreempt_disable();
set_gsr(gsr, lwptofpu(lwp));
if ((lwp == ttolwp(curthread)) && fpu_exists) {
fp->fpu_fprs = _fp_read_fprs();
if ((fp->fpu_fprs & FPRS_FEF) != FPRS_FEF) {
_fp_write_fprs(fprs);
fp->fpu_fprs = (V9_FPU_FPRS_TYPE)fprs;
}
restore_gsr(lwptofpu(lwp));
}
kpreempt_enable();
}
void
getasrs(klwp_t *lwp, asrset_t asr)
{
}
void
getfpasrs(klwp_t *lwp, asrset_t asr)
{
kfpu_t *fp = lwptofpu(lwp);
uint32_t fprs = (FPRS_FEF|FPRS_DU|FPRS_DL);
kpreempt_disable();
if (ttolwp(curthread) == lwp)
fp->fpu_fprs = _fp_read_fprs();
if ((fp->fpu_en) || (fp->fpu_fprs & FPRS_FEF)) {
if (fpu_exists && ttolwp(curthread) == lwp) {
if ((fp->fpu_fprs & FPRS_FEF) != FPRS_FEF) {
_fp_write_fprs(fprs);
fp->fpu_fprs = (V9_FPU_FPRS_TYPE)fprs;
}
save_gsr(fp);
}
asr[ASR_GSR] = (int64_t)get_gsr(fp);
}
kpreempt_enable();
}
void
setasrs(klwp_t *lwp, asrset_t asr)
{
}
void
setfpasrs(klwp_t *lwp, asrset_t asr)
{
kfpu_t *fp = lwptofpu(lwp);
uint32_t fprs = (FPRS_FEF|FPRS_DU|FPRS_DL);
kpreempt_disable();
if (ttolwp(curthread) == lwp)
fp->fpu_fprs = _fp_read_fprs();
if ((fp->fpu_en) || (fp->fpu_fprs & FPRS_FEF)) {
set_gsr(asr[ASR_GSR], fp);
if (fpu_exists && ttolwp(curthread) == lwp) {
if ((fp->fpu_fprs & FPRS_FEF) != FPRS_FEF) {
_fp_write_fprs(fprs);
fp->fpu_fprs = (V9_FPU_FPRS_TYPE)fprs;
}
restore_gsr(fp);
}
}
kpreempt_enable();
}
void
cpu_create_intrstat(cpu_t *cp)
{
int i;
kstat_t *intr_ksp;
kstat_named_t *knp;
char name[KSTAT_STRLEN];
zoneid_t zoneid;
ASSERT(MUTEX_HELD(&cpu_lock));
if (pool_pset_enabled())
zoneid = GLOBAL_ZONEID;
else
zoneid = ALL_ZONES;
intr_ksp = kstat_create_zone("cpu", cp->cpu_id, "intrstat", "misc",
KSTAT_TYPE_NAMED, PIL_MAX * 2, 0, zoneid);
if (intr_ksp != NULL) {
intr_ksp->ks_update = cpu_kstat_intrstat_update;
knp = (kstat_named_t *)intr_ksp->ks_data;
intr_ksp->ks_private = cp;
for (i = 0; i < PIL_MAX; i++) {
(void) snprintf(name, KSTAT_STRLEN, "level-%d-time",
i + 1);
kstat_named_init(&knp[i * 2], name, KSTAT_DATA_UINT64);
(void) snprintf(name, KSTAT_STRLEN, "level-%d-count",
i + 1);
kstat_named_init(&knp[(i * 2) + 1], name,
KSTAT_DATA_UINT64);
}
kstat_install(intr_ksp);
}
}
void
cpu_delete_intrstat(cpu_t *cp)
{
kstat_delete_byname_zone("cpu", cp->cpu_id, "intrstat", ALL_ZONES);
}
int
cpu_kstat_intrstat_update(kstat_t *ksp, int rw)
{
kstat_named_t *knp = ksp->ks_data;
cpu_t *cpup = (cpu_t *)ksp->ks_private;
int i;
if (rw == KSTAT_WRITE)
return (EACCES);
for (i = 0; i < PIL_MAX; i++) {
knp[i * 2].value.ui64 = cpup->cpu_m.intrstat[i + 1][0];
knp[(i * 2) + 1].value.ui64 = cpup->cpu_stats.sys.intr[i];
}
for (i = 0; i < PIL_MAX; i++) {
knp[i * 2].value.ui64 =
(uint64_t)tick2ns((hrtime_t)knp[i * 2].value.ui64,
cpup->cpu_id);
}
return (0);
}
char *
cpu_fru_fmri(cpu_t *cp)
{
return (cpunodes[cp->cpu_id].fru_fmri);
}
void
cpu_intr_swtch_enter(kthread_id_t t)
{
uint64_t interval;
uint64_t start;
cpu_t *cpu;
ASSERT((t->t_flag & T_INTR_THREAD) != 0);
ASSERT(t->t_pil > 0 && t->t_pil <= LOCK_LEVEL);
if (t->t_intr_start) {
do {
start = t->t_intr_start;
interval = CLOCK_TICK_COUNTER() - start;
} while (atomic_cas_64(&t->t_intr_start, start, 0) != start);
cpu = CPU;
if (cpu->cpu_m.divisor > 1)
interval *= cpu->cpu_m.divisor;
cpu->cpu_m.intrstat[t->t_pil][0] += interval;
atomic_add_64((uint64_t *)&cpu->cpu_intracct[cpu->cpu_mstate],
interval);
} else
ASSERT(t->t_intr == NULL || t->t_state == TS_RUN);
}
void
cpu_intr_swtch_exit(kthread_id_t t)
{
uint64_t ts;
ASSERT((t->t_flag & T_INTR_THREAD) != 0);
ASSERT(t->t_pil > 0 && t->t_pil <= LOCK_LEVEL);
do {
ts = t->t_intr_start;
} while (atomic_cas_64(&t->t_intr_start, ts, CLOCK_TICK_COUNTER()) !=
ts);
}
int
blacklist(int cmd, const char *scheme, nvlist_t *fmri, const char *class)
{
if (&plat_blacklist)
return (plat_blacklist(cmd, scheme, fmri, class));
return (ENOTSUP);
}
int
kdi_pread(caddr_t buf, size_t nbytes, uint64_t addr, size_t *ncopiedp)
{
extern void kdi_flush_caches(void);
size_t nread = 0;
uint32_t word;
int slop, i;
kdi_flush_caches();
membar_enter();
if ((slop = addr & 3) != 0) {
word = ldphys(addr & ~3);
for (i = slop; i < 4 && nbytes > 0; i++, nbytes--, nread++)
*buf++ = ((uchar_t *)&word)[i];
addr = roundup(addr, 4);
}
while (nbytes > 0) {
word = ldphys(addr);
for (i = 0; i < 4 && nbytes > 0; i++, nbytes--, nread++, addr++)
*buf++ = ((uchar_t *)&word)[i];
}
kdi_flush_caches();
*ncopiedp = nread;
return (0);
}
int
kdi_pwrite(caddr_t buf, size_t nbytes, uint64_t addr, size_t *ncopiedp)
{
extern void kdi_flush_caches(void);
size_t nwritten = 0;
uint32_t word;
int slop, i;
kdi_flush_caches();
if ((slop = addr & 3) != 0) {
word = ldphys(addr & ~3);
for (i = slop; i < 4 && nbytes > 0; i++, nbytes--, nwritten++)
((uchar_t *)&word)[i] = *buf++;
stphys(addr & ~3, word);
addr = roundup(addr, 4);
}
while (nbytes > 3) {
for (word = 0, i = 0; i < 4; i++, nbytes--, nwritten++)
((uchar_t *)&word)[i] = *buf++;
stphys(addr, word);
addr += 4;
}
if (nbytes > 0) {
word = ldphys(addr);
for (i = 0; nbytes > 0; i++, nbytes--, nwritten++)
((uchar_t *)&word)[i] = *buf++;
stphys(addr, word);
}
membar_enter();
kdi_flush_caches();
*ncopiedp = nwritten;
return (0);
}
static void
kdi_kernpanic(struct regs *regs, uint_t tt)
{
sync_reg_buf = *regs;
sync_tt = tt;
sync_handler();
}
static void
kdi_plat_call(void (*platfn)(void))
{
if (platfn != NULL) {
prom_suspend_prepost();
platfn();
prom_resume_prepost();
}
}
static void
kdi_system_claim(void)
{
lbolt_debug_entry();
}
static void
kdi_system_release(void)
{
lbolt_debug_return();
}
void
mach_kdi_init(kdi_t *kdi)
{
kdi->kdi_plat_call = kdi_plat_call;
kdi->kdi_kmdb_enter = kmdb_enter;
kdi->pkdi_system_claim = kdi_system_claim;
kdi->pkdi_system_release = kdi_system_release;
kdi->mkdi_cpu_index = kdi_cpu_index;
kdi->mkdi_trap_vatotte = kdi_trap_vatotte;
kdi->mkdi_kernpanic = kdi_kernpanic;
}
void
get_cpu_mstate(cpu_t *cpu, hrtime_t *times)
{
int i;
hrtime_t now, start;
uint16_t gen;
uint16_t state;
hrtime_t intracct[NCMSTATES];
now = gethrtime_unscaled();
gen = cpu->cpu_mstate_gen;
membar_consumer();
start = cpu->cpu_mstate_start;
state = cpu->cpu_mstate;
for (i = 0; i < NCMSTATES; i++) {
intracct[i] = cpu->cpu_intracct[i];
times[i] = cpu->cpu_acct[i];
}
membar_consumer();
if (gen != 0 && gen == cpu->cpu_mstate_gen && now > start)
times[state] += now - start;
for (i = 0; i < NCMSTATES; i++) {
scalehrtime(×[i]);
intracct[i] = tick2ns((hrtime_t)intracct[i], cpu->cpu_id);
}
for (i = 0; i < NCMSTATES; i++) {
if (i == CMS_SYSTEM)
continue;
times[i] -= intracct[i];
if (times[i] < 0) {
intracct[i] += times[i];
times[i] = 0;
}
times[CMS_SYSTEM] += intracct[i];
}
}
void
mach_cpu_pause(volatile char *safe)
{
*safe = PAUSE_WAIT;
membar_enter();
while (*safe != PAUSE_IDLE)
SMT_PAUSE();
}
int
plat_mem_do_mmio(struct uio *uio, enum uio_rw rw)
{
return (ENOTSUP);
}
#ifdef sun4v
uint_t dump_plat_mincpu_default = DUMP_PLAT_SUN4V_MINCPU;
#else
uint_t dump_plat_mincpu_default = DUMP_PLAT_SUN4U_MINCPU;
#endif
int
dump_plat_addr()
{
return (0);
}
void
dump_plat_pfn()
{
}
int
dump_plat_data(void *dump_cdata)
{
return (0);
}
int
plat_hold_page(pfn_t pfn, int lock, page_t **pp_ret)
{
return (PLAT_HOLD_OK);
}
void
plat_release_page(page_t *pp)
{
}
void
progressbar_key_abort(ldi_ident_t li)
{
}
static uint64_t lbolt_softint_inum;
void
lbolt_softint_add(void)
{
lbolt_softint_inum = add_softintr(LOCK_LEVEL,
(softintrfunc)lbolt_ev_to_cyclic, NULL, SOFTINT_MT);
}
void
lbolt_softint_post(void)
{
setsoftint(lbolt_softint_inum);
}
void
do_hotinlines(struct module *mp __unused)
{
}