Switch SiByte drivers back to __raw_*() functions.
Signed-off-by: Ralf Baechle <ralf@linux-mips.org>
This commit is contained in:
parent
4912ba72d6
commit
65bda1a95d
|
@ -214,12 +214,12 @@ void sb1_dma_init(void)
|
||||||
int cpu = smp_processor_id();
|
int cpu = smp_processor_id();
|
||||||
u64 base_val = CPHYSADDR(&page_descr[cpu]) | V_DM_DSCR_BASE_RINGSZ(1);
|
u64 base_val = CPHYSADDR(&page_descr[cpu]) | V_DM_DSCR_BASE_RINGSZ(1);
|
||||||
|
|
||||||
bus_writeq(base_val,
|
__raw_writeq(base_val,
|
||||||
(void *)IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE)));
|
IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE)));
|
||||||
bus_writeq(base_val | M_DM_DSCR_BASE_RESET,
|
__raw_writeq(base_val | M_DM_DSCR_BASE_RESET,
|
||||||
(void *)IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE)));
|
IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE)));
|
||||||
bus_writeq(base_val | M_DM_DSCR_BASE_ENABL,
|
__raw_writeq(base_val | M_DM_DSCR_BASE_ENABL,
|
||||||
(void *)IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE)));
|
IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE)));
|
||||||
}
|
}
|
||||||
|
|
||||||
void clear_page(void *page)
|
void clear_page(void *page)
|
||||||
|
@ -232,16 +232,16 @@ void clear_page(void *page)
|
||||||
|
|
||||||
page_descr[cpu].dscr_a = CPHYSADDR(page) | M_DM_DSCRA_ZERO_MEM | M_DM_DSCRA_L2C_DEST | M_DM_DSCRA_INTERRUPT;
|
page_descr[cpu].dscr_a = CPHYSADDR(page) | M_DM_DSCRA_ZERO_MEM | M_DM_DSCRA_L2C_DEST | M_DM_DSCRA_INTERRUPT;
|
||||||
page_descr[cpu].dscr_b = V_DM_DSCRB_SRC_LENGTH(PAGE_SIZE);
|
page_descr[cpu].dscr_b = V_DM_DSCRB_SRC_LENGTH(PAGE_SIZE);
|
||||||
bus_writeq(1, (void *)IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_COUNT)));
|
__raw_writeq(1, IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_COUNT)));
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Don't really want to do it this way, but there's no
|
* Don't really want to do it this way, but there's no
|
||||||
* reliable way to delay completion detection.
|
* reliable way to delay completion detection.
|
||||||
*/
|
*/
|
||||||
while (!(bus_readq((void *)(IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE_DEBUG)) &
|
while (!(__raw_readq(IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE_DEBUG)))
|
||||||
M_DM_DSCR_BASE_INTERRUPT))))
|
M_DM_DSCR_BASE_INTERRUPT)))
|
||||||
;
|
;
|
||||||
bus_readq((void *)IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE)));
|
__raw_readq(IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE)));
|
||||||
}
|
}
|
||||||
|
|
||||||
void copy_page(void *to, void *from)
|
void copy_page(void *to, void *from)
|
||||||
|
@ -257,16 +257,16 @@ void copy_page(void *to, void *from)
|
||||||
|
|
||||||
page_descr[cpu].dscr_a = CPHYSADDR(to_phys) | M_DM_DSCRA_L2C_DEST | M_DM_DSCRA_INTERRUPT;
|
page_descr[cpu].dscr_a = CPHYSADDR(to_phys) | M_DM_DSCRA_L2C_DEST | M_DM_DSCRA_INTERRUPT;
|
||||||
page_descr[cpu].dscr_b = CPHYSADDR(from_phys) | V_DM_DSCRB_SRC_LENGTH(PAGE_SIZE);
|
page_descr[cpu].dscr_b = CPHYSADDR(from_phys) | V_DM_DSCRB_SRC_LENGTH(PAGE_SIZE);
|
||||||
bus_writeq(1, (void *)IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_COUNT)));
|
__raw_writeq(1, IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_COUNT)));
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Don't really want to do it this way, but there's no
|
* Don't really want to do it this way, but there's no
|
||||||
* reliable way to delay completion detection.
|
* reliable way to delay completion detection.
|
||||||
*/
|
*/
|
||||||
while (!(bus_readq((void *)(IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE_DEBUG)) &
|
while (!(__raw_readq(IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE_DEBUG)) &
|
||||||
M_DM_DSCR_BASE_INTERRUPT))))
|
M_DM_DSCR_BASE_INTERRUPT)))
|
||||||
;
|
;
|
||||||
bus_readq((void *)IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE)));
|
__raw_readq(IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE)));
|
||||||
}
|
}
|
||||||
|
|
||||||
#else /* !CONFIG_SIBYTE_DMA_PAGEOPS */
|
#else /* !CONFIG_SIBYTE_DMA_PAGEOPS */
|
||||||
|
|
|
@ -65,24 +65,25 @@ static void arm_tb(void)
|
||||||
u_int64_t tb_options = M_SCD_TRACE_CFG_FREEZE_FULL;
|
u_int64_t tb_options = M_SCD_TRACE_CFG_FREEZE_FULL;
|
||||||
/* Generate an SCD_PERFCNT interrupt in TB_PERIOD Zclks to
|
/* Generate an SCD_PERFCNT interrupt in TB_PERIOD Zclks to
|
||||||
trigger start of trace. XXX vary sampling period */
|
trigger start of trace. XXX vary sampling period */
|
||||||
bus_writeq(0, IOADDR(A_SCD_PERF_CNT_1));
|
__raw_writeq(0, IOADDR(A_SCD_PERF_CNT_1));
|
||||||
scdperfcnt = bus_readq(IOADDR(A_SCD_PERF_CNT_CFG));
|
scdperfcnt = __raw_readq(IOADDR(A_SCD_PERF_CNT_CFG));
|
||||||
/* Unfortunately, in Pass 2 we must clear all counters to knock down
|
/* Unfortunately, in Pass 2 we must clear all counters to knock down
|
||||||
a previous interrupt request. This means that bus profiling
|
a previous interrupt request. This means that bus profiling
|
||||||
requires ALL of the SCD perf counters. */
|
requires ALL of the SCD perf counters. */
|
||||||
bus_writeq((scdperfcnt & ~M_SPC_CFG_SRC1) | // keep counters 0,2,3 as is
|
__raw_writeq((scdperfcnt & ~M_SPC_CFG_SRC1) |
|
||||||
|
// keep counters 0,2,3 as is
|
||||||
M_SPC_CFG_ENABLE | // enable counting
|
M_SPC_CFG_ENABLE | // enable counting
|
||||||
M_SPC_CFG_CLEAR | // clear all counters
|
M_SPC_CFG_CLEAR | // clear all counters
|
||||||
V_SPC_CFG_SRC1(1), // counter 1 counts cycles
|
V_SPC_CFG_SRC1(1), // counter 1 counts cycles
|
||||||
IOADDR(A_SCD_PERF_CNT_CFG));
|
IOADDR(A_SCD_PERF_CNT_CFG));
|
||||||
bus_writeq(next, IOADDR(A_SCD_PERF_CNT_1));
|
__raw_writeq(next, IOADDR(A_SCD_PERF_CNT_1));
|
||||||
/* Reset the trace buffer */
|
/* Reset the trace buffer */
|
||||||
bus_writeq(M_SCD_TRACE_CFG_RESET, IOADDR(A_SCD_TRACE_CFG));
|
__raw_writeq(M_SCD_TRACE_CFG_RESET, IOADDR(A_SCD_TRACE_CFG));
|
||||||
#if 0 && defined(M_SCD_TRACE_CFG_FORCECNT)
|
#if 0 && defined(M_SCD_TRACE_CFG_FORCECNT)
|
||||||
/* XXXKW may want to expose control to the data-collector */
|
/* XXXKW may want to expose control to the data-collector */
|
||||||
tb_options |= M_SCD_TRACE_CFG_FORCECNT;
|
tb_options |= M_SCD_TRACE_CFG_FORCECNT;
|
||||||
#endif
|
#endif
|
||||||
bus_writeq(tb_options, IOADDR(A_SCD_TRACE_CFG));
|
__raw_writeq(tb_options, IOADDR(A_SCD_TRACE_CFG));
|
||||||
sbp.tb_armed = 1;
|
sbp.tb_armed = 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -94,22 +95,29 @@ static irqreturn_t sbprof_tb_intr(int irq, void *dev_id, struct pt_regs *regs)
|
||||||
/* XXX should use XKPHYS to make writes bypass L2 */
|
/* XXX should use XKPHYS to make writes bypass L2 */
|
||||||
u_int64_t *p = sbp.sbprof_tbbuf[sbp.next_tb_sample++];
|
u_int64_t *p = sbp.sbprof_tbbuf[sbp.next_tb_sample++];
|
||||||
/* Read out trace */
|
/* Read out trace */
|
||||||
bus_writeq(M_SCD_TRACE_CFG_START_READ, IOADDR(A_SCD_TRACE_CFG));
|
__raw_writeq(M_SCD_TRACE_CFG_START_READ,
|
||||||
|
IOADDR(A_SCD_TRACE_CFG));
|
||||||
__asm__ __volatile__ ("sync" : : : "memory");
|
__asm__ __volatile__ ("sync" : : : "memory");
|
||||||
/* Loop runs backwards because bundles are read out in reverse order */
|
/* Loop runs backwards because bundles are read out in reverse order */
|
||||||
for (i = 256 * 6; i > 0; i -= 6) {
|
for (i = 256 * 6; i > 0; i -= 6) {
|
||||||
// Subscripts decrease to put bundle in the order
|
// Subscripts decrease to put bundle in the order
|
||||||
// t0 lo, t0 hi, t1 lo, t1 hi, t2 lo, t2 hi
|
// t0 lo, t0 hi, t1 lo, t1 hi, t2 lo, t2 hi
|
||||||
p[i-1] = bus_readq(IOADDR(A_SCD_TRACE_READ)); // read t2 hi
|
p[i - 1] = __raw_readq(IOADDR(A_SCD_TRACE_READ));
|
||||||
p[i-2] = bus_readq(IOADDR(A_SCD_TRACE_READ)); // read t2 lo
|
// read t2 hi
|
||||||
p[i-3] = bus_readq(IOADDR(A_SCD_TRACE_READ)); // read t1 hi
|
p[i - 2] = __raw_readq(IOADDR(A_SCD_TRACE_READ));
|
||||||
p[i-4] = bus_readq(IOADDR(A_SCD_TRACE_READ)); // read t1 lo
|
// read t2 lo
|
||||||
p[i-5] = bus_readq(IOADDR(A_SCD_TRACE_READ)); // read t0 hi
|
p[i - 3] = __raw_readq(IOADDR(A_SCD_TRACE_READ));
|
||||||
p[i-6] = bus_readq(IOADDR(A_SCD_TRACE_READ)); // read t0 lo
|
// read t1 hi
|
||||||
|
p[i - 4] = __raw_readq(IOADDR(A_SCD_TRACE_READ));
|
||||||
|
// read t1 lo
|
||||||
|
p[i - 5] = __raw_readq(IOADDR(A_SCD_TRACE_READ));
|
||||||
|
// read t0 hi
|
||||||
|
p[i - 6] = __raw_readq(IOADDR(A_SCD_TRACE_READ));
|
||||||
|
// read t0 lo
|
||||||
}
|
}
|
||||||
if (!sbp.tb_enable) {
|
if (!sbp.tb_enable) {
|
||||||
DBG(printk(DEVNAME ": tb_intr shutdown\n"));
|
DBG(printk(DEVNAME ": tb_intr shutdown\n"));
|
||||||
bus_writeq(M_SCD_TRACE_CFG_RESET,
|
__raw_writeq(M_SCD_TRACE_CFG_RESET,
|
||||||
IOADDR(A_SCD_TRACE_CFG));
|
IOADDR(A_SCD_TRACE_CFG));
|
||||||
sbp.tb_armed = 0;
|
sbp.tb_armed = 0;
|
||||||
wake_up(&sbp.tb_sync);
|
wake_up(&sbp.tb_sync);
|
||||||
|
@ -119,7 +127,7 @@ static irqreturn_t sbprof_tb_intr(int irq, void *dev_id, struct pt_regs *regs)
|
||||||
} else {
|
} else {
|
||||||
/* No more trace buffer samples */
|
/* No more trace buffer samples */
|
||||||
DBG(printk(DEVNAME ": tb_intr full\n"));
|
DBG(printk(DEVNAME ": tb_intr full\n"));
|
||||||
bus_writeq(M_SCD_TRACE_CFG_RESET, IOADDR(A_SCD_TRACE_CFG));
|
__raw_writeq(M_SCD_TRACE_CFG_RESET, IOADDR(A_SCD_TRACE_CFG));
|
||||||
sbp.tb_armed = 0;
|
sbp.tb_armed = 0;
|
||||||
if (!sbp.tb_enable) {
|
if (!sbp.tb_enable) {
|
||||||
wake_up(&sbp.tb_sync);
|
wake_up(&sbp.tb_sync);
|
||||||
|
@ -153,12 +161,10 @@ int sbprof_zbprof_start(struct file *filp)
|
||||||
return -EBUSY;
|
return -EBUSY;
|
||||||
}
|
}
|
||||||
/* Make sure there isn't a perf-cnt interrupt waiting */
|
/* Make sure there isn't a perf-cnt interrupt waiting */
|
||||||
scdperfcnt = bus_readq(IOADDR(A_SCD_PERF_CNT_CFG));
|
scdperfcnt = __raw_readq(IOADDR(A_SCD_PERF_CNT_CFG));
|
||||||
/* Disable and clear counters, override SRC_1 */
|
/* Disable and clear counters, override SRC_1 */
|
||||||
bus_writeq((scdperfcnt & ~(M_SPC_CFG_SRC1 | M_SPC_CFG_ENABLE)) |
|
__raw_writeq((scdperfcnt & ~(M_SPC_CFG_SRC1 | M_SPC_CFG_ENABLE)) |
|
||||||
M_SPC_CFG_ENABLE |
|
M_SPC_CFG_ENABLE | M_SPC_CFG_CLEAR | V_SPC_CFG_SRC1(1),
|
||||||
M_SPC_CFG_CLEAR |
|
|
||||||
V_SPC_CFG_SRC1(1),
|
|
||||||
IOADDR(A_SCD_PERF_CNT_CFG));
|
IOADDR(A_SCD_PERF_CNT_CFG));
|
||||||
|
|
||||||
/* We grab this interrupt to prevent others from trying to use
|
/* We grab this interrupt to prevent others from trying to use
|
||||||
|
@ -173,54 +179,54 @@ int sbprof_zbprof_start(struct file *filp)
|
||||||
/* I need the core to mask these, but the interrupt mapper to
|
/* I need the core to mask these, but the interrupt mapper to
|
||||||
pass them through. I am exploiting my knowledge that
|
pass them through. I am exploiting my knowledge that
|
||||||
cp0_status masks out IP[5]. krw */
|
cp0_status masks out IP[5]. krw */
|
||||||
bus_writeq(K_INT_MAP_I3,
|
__raw_writeq(K_INT_MAP_I3,
|
||||||
IOADDR(A_IMR_REGISTER(0, R_IMR_INTERRUPT_MAP_BASE) +
|
IOADDR(A_IMR_REGISTER(0, R_IMR_INTERRUPT_MAP_BASE) +
|
||||||
(K_INT_PERF_CNT << 3)));
|
(K_INT_PERF_CNT << 3)));
|
||||||
|
|
||||||
/* Initialize address traps */
|
/* Initialize address traps */
|
||||||
bus_writeq(0, IOADDR(A_ADDR_TRAP_UP_0));
|
__raw_writeq(0, IOADDR(A_ADDR_TRAP_UP_0));
|
||||||
bus_writeq(0, IOADDR(A_ADDR_TRAP_UP_1));
|
__raw_writeq(0, IOADDR(A_ADDR_TRAP_UP_1));
|
||||||
bus_writeq(0, IOADDR(A_ADDR_TRAP_UP_2));
|
__raw_writeq(0, IOADDR(A_ADDR_TRAP_UP_2));
|
||||||
bus_writeq(0, IOADDR(A_ADDR_TRAP_UP_3));
|
__raw_writeq(0, IOADDR(A_ADDR_TRAP_UP_3));
|
||||||
|
|
||||||
bus_writeq(0, IOADDR(A_ADDR_TRAP_DOWN_0));
|
__raw_writeq(0, IOADDR(A_ADDR_TRAP_DOWN_0));
|
||||||
bus_writeq(0, IOADDR(A_ADDR_TRAP_DOWN_1));
|
__raw_writeq(0, IOADDR(A_ADDR_TRAP_DOWN_1));
|
||||||
bus_writeq(0, IOADDR(A_ADDR_TRAP_DOWN_2));
|
__raw_writeq(0, IOADDR(A_ADDR_TRAP_DOWN_2));
|
||||||
bus_writeq(0, IOADDR(A_ADDR_TRAP_DOWN_3));
|
__raw_writeq(0, IOADDR(A_ADDR_TRAP_DOWN_3));
|
||||||
|
|
||||||
bus_writeq(0, IOADDR(A_ADDR_TRAP_CFG_0));
|
__raw_writeq(0, IOADDR(A_ADDR_TRAP_CFG_0));
|
||||||
bus_writeq(0, IOADDR(A_ADDR_TRAP_CFG_1));
|
__raw_writeq(0, IOADDR(A_ADDR_TRAP_CFG_1));
|
||||||
bus_writeq(0, IOADDR(A_ADDR_TRAP_CFG_2));
|
__raw_writeq(0, IOADDR(A_ADDR_TRAP_CFG_2));
|
||||||
bus_writeq(0, IOADDR(A_ADDR_TRAP_CFG_3));
|
__raw_writeq(0, IOADDR(A_ADDR_TRAP_CFG_3));
|
||||||
|
|
||||||
/* Initialize Trace Event 0-7 */
|
/* Initialize Trace Event 0-7 */
|
||||||
// when interrupt
|
// when interrupt
|
||||||
bus_writeq(M_SCD_TREVT_INTERRUPT, IOADDR(A_SCD_TRACE_EVENT_0));
|
__raw_writeq(M_SCD_TREVT_INTERRUPT, IOADDR(A_SCD_TRACE_EVENT_0));
|
||||||
bus_writeq(0, IOADDR(A_SCD_TRACE_EVENT_1));
|
__raw_writeq(0, IOADDR(A_SCD_TRACE_EVENT_1));
|
||||||
bus_writeq(0, IOADDR(A_SCD_TRACE_EVENT_2));
|
__raw_writeq(0, IOADDR(A_SCD_TRACE_EVENT_2));
|
||||||
bus_writeq(0, IOADDR(A_SCD_TRACE_EVENT_3));
|
__raw_writeq(0, IOADDR(A_SCD_TRACE_EVENT_3));
|
||||||
bus_writeq(0, IOADDR(A_SCD_TRACE_EVENT_4));
|
__raw_writeq(0, IOADDR(A_SCD_TRACE_EVENT_4));
|
||||||
bus_writeq(0, IOADDR(A_SCD_TRACE_EVENT_5));
|
__raw_writeq(0, IOADDR(A_SCD_TRACE_EVENT_5));
|
||||||
bus_writeq(0, IOADDR(A_SCD_TRACE_EVENT_6));
|
__raw_writeq(0, IOADDR(A_SCD_TRACE_EVENT_6));
|
||||||
bus_writeq(0, IOADDR(A_SCD_TRACE_EVENT_7));
|
__raw_writeq(0, IOADDR(A_SCD_TRACE_EVENT_7));
|
||||||
|
|
||||||
/* Initialize Trace Sequence 0-7 */
|
/* Initialize Trace Sequence 0-7 */
|
||||||
// Start on event 0 (interrupt)
|
// Start on event 0 (interrupt)
|
||||||
bus_writeq(V_SCD_TRSEQ_FUNC_START | 0x0fff,
|
__raw_writeq(V_SCD_TRSEQ_FUNC_START | 0x0fff,
|
||||||
IOADDR(A_SCD_TRACE_SEQUENCE_0));
|
IOADDR(A_SCD_TRACE_SEQUENCE_0));
|
||||||
// dsamp when d used | asamp when a used
|
// dsamp when d used | asamp when a used
|
||||||
bus_writeq(M_SCD_TRSEQ_ASAMPLE | M_SCD_TRSEQ_DSAMPLE |
|
__raw_writeq(M_SCD_TRSEQ_ASAMPLE | M_SCD_TRSEQ_DSAMPLE |
|
||||||
K_SCD_TRSEQ_TRIGGER_ALL,
|
K_SCD_TRSEQ_TRIGGER_ALL,
|
||||||
IOADDR(A_SCD_TRACE_SEQUENCE_1));
|
IOADDR(A_SCD_TRACE_SEQUENCE_1));
|
||||||
bus_writeq(0, IOADDR(A_SCD_TRACE_SEQUENCE_2));
|
__raw_writeq(0, IOADDR(A_SCD_TRACE_SEQUENCE_2));
|
||||||
bus_writeq(0, IOADDR(A_SCD_TRACE_SEQUENCE_3));
|
__raw_writeq(0, IOADDR(A_SCD_TRACE_SEQUENCE_3));
|
||||||
bus_writeq(0, IOADDR(A_SCD_TRACE_SEQUENCE_4));
|
__raw_writeq(0, IOADDR(A_SCD_TRACE_SEQUENCE_4));
|
||||||
bus_writeq(0, IOADDR(A_SCD_TRACE_SEQUENCE_5));
|
__raw_writeq(0, IOADDR(A_SCD_TRACE_SEQUENCE_5));
|
||||||
bus_writeq(0, IOADDR(A_SCD_TRACE_SEQUENCE_6));
|
__raw_writeq(0, IOADDR(A_SCD_TRACE_SEQUENCE_6));
|
||||||
bus_writeq(0, IOADDR(A_SCD_TRACE_SEQUENCE_7));
|
__raw_writeq(0, IOADDR(A_SCD_TRACE_SEQUENCE_7));
|
||||||
|
|
||||||
/* Now indicate the PERF_CNT interrupt as a trace-relevant interrupt */
|
/* Now indicate the PERF_CNT interrupt as a trace-relevant interrupt */
|
||||||
bus_writeq((1ULL << K_INT_PERF_CNT),
|
__raw_writeq(1ULL << K_INT_PERF_CNT,
|
||||||
IOADDR(A_IMR_REGISTER(0, R_IMR_INTERRUPT_TRACE)));
|
IOADDR(A_IMR_REGISTER(0, R_IMR_INTERRUPT_TRACE)));
|
||||||
|
|
||||||
arm_tb();
|
arm_tb();
|
||||||
|
|
|
@ -189,7 +189,7 @@ static irqreturn_t sibyte_bw_int(int irq, void *data, struct pt_regs *regs)
|
||||||
|
|
||||||
for (i=0; i<256*6; i++)
|
for (i=0; i<256*6; i++)
|
||||||
printk("%016llx\n",
|
printk("%016llx\n",
|
||||||
(unsigned long long)bus_readq(IOADDR(A_SCD_TRACE_READ)));
|
(long long)__raw_readq(IOADDR(A_SCD_TRACE_READ)));
|
||||||
|
|
||||||
csr_out32(M_SCD_TRACE_CFG_RESET, IOADDR(A_SCD_TRACE_CFG));
|
csr_out32(M_SCD_TRACE_CFG_RESET, IOADDR(A_SCD_TRACE_CFG));
|
||||||
csr_out32(M_SCD_TRACE_CFG_START, IOADDR(A_SCD_TRACE_CFG));
|
csr_out32(M_SCD_TRACE_CFG_START, IOADDR(A_SCD_TRACE_CFG));
|
||||||
|
|
|
@ -96,10 +96,10 @@ void sb1250_mask_irq(int cpu, int irq)
|
||||||
u64 cur_ints;
|
u64 cur_ints;
|
||||||
|
|
||||||
spin_lock_irqsave(&sb1250_imr_lock, flags);
|
spin_lock_irqsave(&sb1250_imr_lock, flags);
|
||||||
cur_ints = __bus_readq(IOADDR(A_IMR_MAPPER(cpu) +
|
cur_ints = ____raw_readq(IOADDR(A_IMR_MAPPER(cpu) +
|
||||||
R_IMR_INTERRUPT_MASK));
|
R_IMR_INTERRUPT_MASK));
|
||||||
cur_ints |= (((u64) 1) << irq);
|
cur_ints |= (((u64) 1) << irq);
|
||||||
__bus_writeq(cur_ints, IOADDR(A_IMR_MAPPER(cpu) +
|
____raw_writeq(cur_ints, IOADDR(A_IMR_MAPPER(cpu) +
|
||||||
R_IMR_INTERRUPT_MASK));
|
R_IMR_INTERRUPT_MASK));
|
||||||
spin_unlock_irqrestore(&sb1250_imr_lock, flags);
|
spin_unlock_irqrestore(&sb1250_imr_lock, flags);
|
||||||
}
|
}
|
||||||
|
@ -110,10 +110,10 @@ void sb1250_unmask_irq(int cpu, int irq)
|
||||||
u64 cur_ints;
|
u64 cur_ints;
|
||||||
|
|
||||||
spin_lock_irqsave(&sb1250_imr_lock, flags);
|
spin_lock_irqsave(&sb1250_imr_lock, flags);
|
||||||
cur_ints = __bus_readq(IOADDR(A_IMR_MAPPER(cpu) +
|
cur_ints = ____raw_readq(IOADDR(A_IMR_MAPPER(cpu) +
|
||||||
R_IMR_INTERRUPT_MASK));
|
R_IMR_INTERRUPT_MASK));
|
||||||
cur_ints &= ~(((u64) 1) << irq);
|
cur_ints &= ~(((u64) 1) << irq);
|
||||||
__bus_writeq(cur_ints, IOADDR(A_IMR_MAPPER(cpu) +
|
____raw_writeq(cur_ints, IOADDR(A_IMR_MAPPER(cpu) +
|
||||||
R_IMR_INTERRUPT_MASK));
|
R_IMR_INTERRUPT_MASK));
|
||||||
spin_unlock_irqrestore(&sb1250_imr_lock, flags);
|
spin_unlock_irqrestore(&sb1250_imr_lock, flags);
|
||||||
}
|
}
|
||||||
|
@ -149,22 +149,22 @@ static void sb1250_set_affinity(unsigned int irq, unsigned long mask)
|
||||||
|
|
||||||
/* Swizzle each CPU's IMR (but leave the IP selection alone) */
|
/* Swizzle each CPU's IMR (but leave the IP selection alone) */
|
||||||
old_cpu = sb1250_irq_owner[irq];
|
old_cpu = sb1250_irq_owner[irq];
|
||||||
cur_ints = __bus_readq(IOADDR(A_IMR_MAPPER(old_cpu) +
|
cur_ints = ____raw_readq(IOADDR(A_IMR_MAPPER(old_cpu) +
|
||||||
R_IMR_INTERRUPT_MASK));
|
R_IMR_INTERRUPT_MASK));
|
||||||
int_on = !(cur_ints & (((u64) 1) << irq));
|
int_on = !(cur_ints & (((u64) 1) << irq));
|
||||||
if (int_on) {
|
if (int_on) {
|
||||||
/* If it was on, mask it */
|
/* If it was on, mask it */
|
||||||
cur_ints |= (((u64) 1) << irq);
|
cur_ints |= (((u64) 1) << irq);
|
||||||
__bus_writeq(cur_ints, IOADDR(A_IMR_MAPPER(old_cpu) +
|
____raw_writeq(cur_ints, IOADDR(A_IMR_MAPPER(old_cpu) +
|
||||||
R_IMR_INTERRUPT_MASK));
|
R_IMR_INTERRUPT_MASK));
|
||||||
}
|
}
|
||||||
sb1250_irq_owner[irq] = cpu;
|
sb1250_irq_owner[irq] = cpu;
|
||||||
if (int_on) {
|
if (int_on) {
|
||||||
/* unmask for the new CPU */
|
/* unmask for the new CPU */
|
||||||
cur_ints = __bus_readq(IOADDR(A_IMR_MAPPER(cpu) +
|
cur_ints = ____raw_readq(IOADDR(A_IMR_MAPPER(cpu) +
|
||||||
R_IMR_INTERRUPT_MASK));
|
R_IMR_INTERRUPT_MASK));
|
||||||
cur_ints &= ~(((u64) 1) << irq);
|
cur_ints &= ~(((u64) 1) << irq);
|
||||||
__bus_writeq(cur_ints, IOADDR(A_IMR_MAPPER(cpu) +
|
____raw_writeq(cur_ints, IOADDR(A_IMR_MAPPER(cpu) +
|
||||||
R_IMR_INTERRUPT_MASK));
|
R_IMR_INTERRUPT_MASK));
|
||||||
}
|
}
|
||||||
spin_unlock(&sb1250_imr_lock);
|
spin_unlock(&sb1250_imr_lock);
|
||||||
|
@ -208,7 +208,7 @@ static void ack_sb1250_irq(unsigned int irq)
|
||||||
* deliver the interrupts to all CPUs (which makes affinity
|
* deliver the interrupts to all CPUs (which makes affinity
|
||||||
* changing easier for us)
|
* changing easier for us)
|
||||||
*/
|
*/
|
||||||
pending = bus_readq(IOADDR(A_IMR_REGISTER(sb1250_irq_owner[irq],
|
pending = __raw_readq(IOADDR(A_IMR_REGISTER(sb1250_irq_owner[irq],
|
||||||
R_IMR_LDT_INTERRUPT)));
|
R_IMR_LDT_INTERRUPT)));
|
||||||
pending &= ((u64)1 << (irq));
|
pending &= ((u64)1 << (irq));
|
||||||
if (pending) {
|
if (pending) {
|
||||||
|
@ -224,7 +224,7 @@ static void ack_sb1250_irq(unsigned int irq)
|
||||||
* Clear for all CPUs so an affinity switch
|
* Clear for all CPUs so an affinity switch
|
||||||
* doesn't find an old status
|
* doesn't find an old status
|
||||||
*/
|
*/
|
||||||
bus_writeq(pending,
|
__raw_writeq(pending,
|
||||||
IOADDR(A_IMR_REGISTER(cpu,
|
IOADDR(A_IMR_REGISTER(cpu,
|
||||||
R_IMR_LDT_INTERRUPT_CLR)));
|
R_IMR_LDT_INTERRUPT_CLR)));
|
||||||
}
|
}
|
||||||
|
@ -340,11 +340,13 @@ void __init arch_init_irq(void)
|
||||||
|
|
||||||
/* Default everything to IP2 */
|
/* Default everything to IP2 */
|
||||||
for (i = 0; i < SB1250_NR_IRQS; i++) { /* was I0 */
|
for (i = 0; i < SB1250_NR_IRQS; i++) { /* was I0 */
|
||||||
bus_writeq(IMR_IP2_VAL,
|
__raw_writeq(IMR_IP2_VAL,
|
||||||
IOADDR(A_IMR_REGISTER(0, R_IMR_INTERRUPT_MAP_BASE) +
|
IOADDR(A_IMR_REGISTER(0,
|
||||||
|
R_IMR_INTERRUPT_MAP_BASE) +
|
||||||
(i << 3)));
|
(i << 3)));
|
||||||
bus_writeq(IMR_IP2_VAL,
|
__raw_writeq(IMR_IP2_VAL,
|
||||||
IOADDR(A_IMR_REGISTER(1, R_IMR_INTERRUPT_MAP_BASE) +
|
IOADDR(A_IMR_REGISTER(1,
|
||||||
|
R_IMR_INTERRUPT_MAP_BASE) +
|
||||||
(i << 3)));
|
(i << 3)));
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -355,23 +357,23 @@ void __init arch_init_irq(void)
|
||||||
* inter-cpu messages
|
* inter-cpu messages
|
||||||
*/
|
*/
|
||||||
/* Was I1 */
|
/* Was I1 */
|
||||||
bus_writeq(IMR_IP3_VAL,
|
__raw_writeq(IMR_IP3_VAL,
|
||||||
IOADDR(A_IMR_REGISTER(0, R_IMR_INTERRUPT_MAP_BASE) +
|
IOADDR(A_IMR_REGISTER(0, R_IMR_INTERRUPT_MAP_BASE) +
|
||||||
(K_INT_MBOX_0 << 3)));
|
(K_INT_MBOX_0 << 3)));
|
||||||
bus_writeq(IMR_IP3_VAL,
|
__raw_writeq(IMR_IP3_VAL,
|
||||||
IOADDR(A_IMR_REGISTER(1, R_IMR_INTERRUPT_MAP_BASE) +
|
IOADDR(A_IMR_REGISTER(1, R_IMR_INTERRUPT_MAP_BASE) +
|
||||||
(K_INT_MBOX_0 << 3)));
|
(K_INT_MBOX_0 << 3)));
|
||||||
|
|
||||||
/* Clear the mailboxes. The firmware may leave them dirty */
|
/* Clear the mailboxes. The firmware may leave them dirty */
|
||||||
bus_writeq(0xffffffffffffffffULL,
|
__raw_writeq(0xffffffffffffffffULL,
|
||||||
IOADDR(A_IMR_REGISTER(0, R_IMR_MAILBOX_CLR_CPU)));
|
IOADDR(A_IMR_REGISTER(0, R_IMR_MAILBOX_CLR_CPU)));
|
||||||
bus_writeq(0xffffffffffffffffULL,
|
__raw_writeq(0xffffffffffffffffULL,
|
||||||
IOADDR(A_IMR_REGISTER(1, R_IMR_MAILBOX_CLR_CPU)));
|
IOADDR(A_IMR_REGISTER(1, R_IMR_MAILBOX_CLR_CPU)));
|
||||||
|
|
||||||
/* Mask everything except the mailbox registers for both cpus */
|
/* Mask everything except the mailbox registers for both cpus */
|
||||||
tmp = ~((u64) 0) ^ (((u64) 1) << K_INT_MBOX_0);
|
tmp = ~((u64) 0) ^ (((u64) 1) << K_INT_MBOX_0);
|
||||||
bus_writeq(tmp, IOADDR(A_IMR_REGISTER(0, R_IMR_INTERRUPT_MASK)));
|
__raw_writeq(tmp, IOADDR(A_IMR_REGISTER(0, R_IMR_INTERRUPT_MASK)));
|
||||||
bus_writeq(tmp, IOADDR(A_IMR_REGISTER(1, R_IMR_INTERRUPT_MASK)));
|
__raw_writeq(tmp, IOADDR(A_IMR_REGISTER(1, R_IMR_INTERRUPT_MASK)));
|
||||||
|
|
||||||
sb1250_steal_irq(K_INT_MBOX_0);
|
sb1250_steal_irq(K_INT_MBOX_0);
|
||||||
|
|
||||||
|
@ -396,11 +398,13 @@ void __init arch_init_irq(void)
|
||||||
sb1250_duart_present[kgdb_port] = 0;
|
sb1250_duart_present[kgdb_port] = 0;
|
||||||
#endif
|
#endif
|
||||||
/* Setup uart 1 settings, mapper */
|
/* Setup uart 1 settings, mapper */
|
||||||
bus_writeq(M_DUART_IMR_BRK, IOADDR(A_DUART_IMRREG(kgdb_port)));
|
__raw_writeq(M_DUART_IMR_BRK,
|
||||||
|
IOADDR(A_DUART_IMRREG(kgdb_port)));
|
||||||
|
|
||||||
sb1250_steal_irq(kgdb_irq);
|
sb1250_steal_irq(kgdb_irq);
|
||||||
bus_writeq(IMR_IP6_VAL,
|
__raw_writeq(IMR_IP6_VAL,
|
||||||
IOADDR(A_IMR_REGISTER(0, R_IMR_INTERRUPT_MAP_BASE) +
|
IOADDR(A_IMR_REGISTER(0,
|
||||||
|
R_IMR_INTERRUPT_MAP_BASE) +
|
||||||
(kgdb_irq << 3)));
|
(kgdb_irq << 3)));
|
||||||
sb1250_unmask_irq(0, kgdb_irq);
|
sb1250_unmask_irq(0, kgdb_irq);
|
||||||
}
|
}
|
||||||
|
|
|
@ -153,7 +153,7 @@ void sb1250_setup(void)
|
||||||
int bad_config = 0;
|
int bad_config = 0;
|
||||||
|
|
||||||
sb1_pass = read_c0_prid() & 0xff;
|
sb1_pass = read_c0_prid() & 0xff;
|
||||||
sys_rev = bus_readq(IOADDR(A_SCD_SYSTEM_REVISION));
|
sys_rev = __raw_readq(IOADDR(A_SCD_SYSTEM_REVISION));
|
||||||
soc_type = SYS_SOC_TYPE(sys_rev);
|
soc_type = SYS_SOC_TYPE(sys_rev);
|
||||||
soc_pass = G_SYS_REVISION(sys_rev);
|
soc_pass = G_SYS_REVISION(sys_rev);
|
||||||
|
|
||||||
|
@ -162,7 +162,7 @@ void sb1250_setup(void)
|
||||||
machine_restart(NULL);
|
machine_restart(NULL);
|
||||||
}
|
}
|
||||||
|
|
||||||
plldiv = G_SYS_PLL_DIV(bus_readq(IOADDR(A_SCD_SYSTEM_CFG)));
|
plldiv = G_SYS_PLL_DIV(__raw_readq(IOADDR(A_SCD_SYSTEM_CFG)));
|
||||||
zbbus_mhz = ((plldiv >> 1) * 50) + ((plldiv & 1) * 25);
|
zbbus_mhz = ((plldiv >> 1) * 50) + ((plldiv & 1) * 25);
|
||||||
|
|
||||||
prom_printf("Broadcom SiByte %s %s @ %d MHz (SB1 rev %d)\n",
|
prom_printf("Broadcom SiByte %s %s @ %d MHz (SB1 rev %d)\n",
|
||||||
|
|
|
@ -29,18 +29,18 @@
|
||||||
#include <asm/sibyte/sb1250_int.h>
|
#include <asm/sibyte/sb1250_int.h>
|
||||||
|
|
||||||
static void *mailbox_set_regs[] = {
|
static void *mailbox_set_regs[] = {
|
||||||
(void *)IOADDR(A_IMR_CPU0_BASE + R_IMR_MAILBOX_SET_CPU),
|
IOADDR(A_IMR_CPU0_BASE + R_IMR_MAILBOX_SET_CPU),
|
||||||
(void *)IOADDR(A_IMR_CPU1_BASE + R_IMR_MAILBOX_SET_CPU)
|
IOADDR(A_IMR_CPU1_BASE + R_IMR_MAILBOX_SET_CPU)
|
||||||
};
|
};
|
||||||
|
|
||||||
static void *mailbox_clear_regs[] = {
|
static void *mailbox_clear_regs[] = {
|
||||||
(void *)IOADDR(A_IMR_CPU0_BASE + R_IMR_MAILBOX_CLR_CPU),
|
IOADDR(A_IMR_CPU0_BASE + R_IMR_MAILBOX_CLR_CPU),
|
||||||
(void *)IOADDR(A_IMR_CPU1_BASE + R_IMR_MAILBOX_CLR_CPU)
|
IOADDR(A_IMR_CPU1_BASE + R_IMR_MAILBOX_CLR_CPU)
|
||||||
};
|
};
|
||||||
|
|
||||||
static void *mailbox_regs[] = {
|
static void *mailbox_regs[] = {
|
||||||
(void *)IOADDR(A_IMR_CPU0_BASE + R_IMR_MAILBOX_CPU),
|
IOADDR(A_IMR_CPU0_BASE + R_IMR_MAILBOX_CPU),
|
||||||
(void *)IOADDR(A_IMR_CPU1_BASE + R_IMR_MAILBOX_CPU)
|
IOADDR(A_IMR_CPU1_BASE + R_IMR_MAILBOX_CPU)
|
||||||
};
|
};
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -73,7 +73,7 @@ void sb1250_smp_finish(void)
|
||||||
*/
|
*/
|
||||||
void core_send_ipi(int cpu, unsigned int action)
|
void core_send_ipi(int cpu, unsigned int action)
|
||||||
{
|
{
|
||||||
bus_writeq((((u64)action) << 48), mailbox_set_regs[cpu]);
|
__raw_writeq((((u64)action) << 48), mailbox_set_regs[cpu]);
|
||||||
}
|
}
|
||||||
|
|
||||||
void sb1250_mailbox_interrupt(struct pt_regs *regs)
|
void sb1250_mailbox_interrupt(struct pt_regs *regs)
|
||||||
|
@ -83,10 +83,10 @@ void sb1250_mailbox_interrupt(struct pt_regs *regs)
|
||||||
|
|
||||||
kstat_this_cpu.irqs[K_INT_MBOX_0]++;
|
kstat_this_cpu.irqs[K_INT_MBOX_0]++;
|
||||||
/* Load the mailbox register to figure out what we're supposed to do */
|
/* Load the mailbox register to figure out what we're supposed to do */
|
||||||
action = (__bus_readq(mailbox_regs[cpu]) >> 48) & 0xffff;
|
action = (____raw_readq(mailbox_regs[cpu]) >> 48) & 0xffff;
|
||||||
|
|
||||||
/* Clear the mailbox to clear the interrupt */
|
/* Clear the mailbox to clear the interrupt */
|
||||||
__bus_writeq(((u64)action) << 48, mailbox_clear_regs[cpu]);
|
____raw_writeq(((u64)action) << 48, mailbox_clear_regs[cpu]);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Nothing to do for SMP_RESCHEDULE_YOURSELF; returning from the
|
* Nothing to do for SMP_RESCHEDULE_YOURSELF; returning from the
|
||||||
|
|
|
@ -67,23 +67,23 @@ void sb1250_time_init(void)
|
||||||
sb1250_mask_irq(cpu, irq);
|
sb1250_mask_irq(cpu, irq);
|
||||||
|
|
||||||
/* Map the timer interrupt to ip[4] of this cpu */
|
/* Map the timer interrupt to ip[4] of this cpu */
|
||||||
bus_writeq(IMR_IP4_VAL,
|
__raw_writeq(IMR_IP4_VAL,
|
||||||
IOADDR(A_IMR_REGISTER(cpu, R_IMR_INTERRUPT_MAP_BASE) +
|
IOADDR(A_IMR_REGISTER(cpu, R_IMR_INTERRUPT_MAP_BASE) +
|
||||||
(irq << 3)));
|
(irq << 3)));
|
||||||
|
|
||||||
/* the general purpose timer ticks at 1 Mhz independent if the rest of the system */
|
/* the general purpose timer ticks at 1 Mhz independent if the rest of the system */
|
||||||
/* Disable the timer and set up the count */
|
/* Disable the timer and set up the count */
|
||||||
bus_writeq(0, IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_CFG)));
|
__raw_writeq(0, IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_CFG)));
|
||||||
#ifdef CONFIG_SIMULATION
|
#ifdef CONFIG_SIMULATION
|
||||||
bus_writeq(50000 / HZ,
|
__raw_writeq(50000 / HZ,
|
||||||
IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_INIT)));
|
IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_INIT)));
|
||||||
#else
|
#else
|
||||||
bus_writeq(1000000/HZ,
|
__raw_writeq(1000000 / HZ,
|
||||||
IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_INIT)));
|
IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_INIT)));
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
/* Set the timer running */
|
/* Set the timer running */
|
||||||
bus_writeq(M_SCD_TIMER_ENABLE | M_SCD_TIMER_MODE_CONTINUOUS,
|
__raw_writeq(M_SCD_TIMER_ENABLE | M_SCD_TIMER_MODE_CONTINUOUS,
|
||||||
IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_CFG)));
|
IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_CFG)));
|
||||||
|
|
||||||
sb1250_unmask_irq(cpu, irq);
|
sb1250_unmask_irq(cpu, irq);
|
||||||
|
@ -105,7 +105,7 @@ void sb1250_timer_interrupt(struct pt_regs *regs)
|
||||||
int irq = K_INT_TIMER_0 + cpu;
|
int irq = K_INT_TIMER_0 + cpu;
|
||||||
|
|
||||||
/* Reset the timer */
|
/* Reset the timer */
|
||||||
__bus_writeq(M_SCD_TIMER_ENABLE | M_SCD_TIMER_MODE_CONTINUOUS,
|
____raw_writeq(M_SCD_TIMER_ENABLE | M_SCD_TIMER_MODE_CONTINUOUS,
|
||||||
IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_CFG)));
|
IOADDR(A_SCD_TIMER_REGISTER(cpu, R_SCD_TIMER_CFG)));
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -130,7 +130,7 @@ void sb1250_timer_interrupt(struct pt_regs *regs)
|
||||||
unsigned long sb1250_gettimeoffset(void)
|
unsigned long sb1250_gettimeoffset(void)
|
||||||
{
|
{
|
||||||
unsigned long count =
|
unsigned long count =
|
||||||
bus_readq(IOADDR(A_SCD_TIMER_REGISTER(0, R_SCD_TIMER_CNT)));
|
__raw_readq(IOADDR(A_SCD_TIMER_REGISTER(0, R_SCD_TIMER_CNT)));
|
||||||
|
|
||||||
return 1000000/HZ - count;
|
return 1000000/HZ - count;
|
||||||
}
|
}
|
||||||
|
|
|
@ -82,59 +82,60 @@
|
||||||
#define M41T81REG_SQW 0x13 /* square wave register */
|
#define M41T81REG_SQW 0x13 /* square wave register */
|
||||||
|
|
||||||
#define M41T81_CCR_ADDRESS 0x68
|
#define M41T81_CCR_ADDRESS 0x68
|
||||||
#define SMB_CSR(reg) ((u8 *) (IOADDR(A_SMB_REGISTER(1, reg))))
|
|
||||||
|
#define SMB_CSR(reg) IOADDR(A_SMB_REGISTER(1, reg))
|
||||||
|
|
||||||
static int m41t81_read(uint8_t addr)
|
static int m41t81_read(uint8_t addr)
|
||||||
{
|
{
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
bus_writeq(addr & 0xff, SMB_CSR(R_SMB_CMD));
|
__raw_writeq(addr & 0xff, SMB_CSR(R_SMB_CMD));
|
||||||
bus_writeq((V_SMB_ADDR(M41T81_CCR_ADDRESS) | V_SMB_TT_WR1BYTE),
|
__raw_writeq(V_SMB_ADDR(M41T81_CCR_ADDRESS) | V_SMB_TT_WR1BYTE,
|
||||||
SMB_CSR(R_SMB_START));
|
SMB_CSR(R_SMB_START));
|
||||||
|
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
bus_writeq((V_SMB_ADDR(M41T81_CCR_ADDRESS) | V_SMB_TT_RD1BYTE),
|
__raw_writeq(V_SMB_ADDR(M41T81_CCR_ADDRESS) | V_SMB_TT_RD1BYTE,
|
||||||
SMB_CSR(R_SMB_START));
|
SMB_CSR(R_SMB_START));
|
||||||
|
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
if (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_ERROR) {
|
if (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_ERROR) {
|
||||||
/* Clear error bit by writing a 1 */
|
/* Clear error bit by writing a 1 */
|
||||||
bus_writeq(M_SMB_ERROR, SMB_CSR(R_SMB_STATUS));
|
__raw_writeq(M_SMB_ERROR, SMB_CSR(R_SMB_STATUS));
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
return (bus_readq(SMB_CSR(R_SMB_DATA)) & 0xff);
|
return (__raw_readq(SMB_CSR(R_SMB_DATA)) & 0xff);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int m41t81_write(uint8_t addr, int b)
|
static int m41t81_write(uint8_t addr, int b)
|
||||||
{
|
{
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
bus_writeq((addr & 0xFF), SMB_CSR(R_SMB_CMD));
|
__raw_writeq(addr & 0xff, SMB_CSR(R_SMB_CMD));
|
||||||
bus_writeq((b & 0xff), SMB_CSR(R_SMB_DATA));
|
__raw_writeq(b & 0xff, SMB_CSR(R_SMB_DATA));
|
||||||
bus_writeq(V_SMB_ADDR(M41T81_CCR_ADDRESS) | V_SMB_TT_WR2BYTE,
|
__raw_writeq(V_SMB_ADDR(M41T81_CCR_ADDRESS) | V_SMB_TT_WR2BYTE,
|
||||||
SMB_CSR(R_SMB_START));
|
SMB_CSR(R_SMB_START));
|
||||||
|
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
if (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_ERROR) {
|
if (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_ERROR) {
|
||||||
/* Clear error bit by writing a 1 */
|
/* Clear error bit by writing a 1 */
|
||||||
bus_writeq(M_SMB_ERROR, SMB_CSR(R_SMB_STATUS));
|
__raw_writeq(M_SMB_ERROR, SMB_CSR(R_SMB_STATUS));
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* read the same byte again to make sure it is written */
|
/* read the same byte again to make sure it is written */
|
||||||
bus_writeq(V_SMB_ADDR(M41T81_CCR_ADDRESS) | V_SMB_TT_RD1BYTE,
|
__raw_writeq(V_SMB_ADDR(M41T81_CCR_ADDRESS) | V_SMB_TT_RD1BYTE,
|
||||||
SMB_CSR(R_SMB_START));
|
SMB_CSR(R_SMB_START));
|
||||||
|
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
|
@ -57,52 +57,52 @@
|
||||||
|
|
||||||
#define X1241_CCR_ADDRESS 0x6F
|
#define X1241_CCR_ADDRESS 0x6F
|
||||||
|
|
||||||
#define SMB_CSR(reg) ((u8 *) (IOADDR(A_SMB_REGISTER(1, reg))))
|
#define SMB_CSR(reg) IOADDR(A_SMB_REGISTER(1, reg))
|
||||||
|
|
||||||
static int xicor_read(uint8_t addr)
|
static int xicor_read(uint8_t addr)
|
||||||
{
|
{
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
bus_writeq((addr >> 8) & 0x7, SMB_CSR(R_SMB_CMD));
|
__raw_writeq((addr >> 8) & 0x7, SMB_CSR(R_SMB_CMD));
|
||||||
bus_writeq((addr & 0xff), SMB_CSR(R_SMB_DATA));
|
__raw_writeq(addr & 0xff, SMB_CSR(R_SMB_DATA));
|
||||||
bus_writeq((V_SMB_ADDR(X1241_CCR_ADDRESS) | V_SMB_TT_WR2BYTE),
|
__raw_writeq(V_SMB_ADDR(X1241_CCR_ADDRESS) | V_SMB_TT_WR2BYTE,
|
||||||
SMB_CSR(R_SMB_START));
|
SMB_CSR(R_SMB_START));
|
||||||
|
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
bus_writeq((V_SMB_ADDR(X1241_CCR_ADDRESS) | V_SMB_TT_RD1BYTE),
|
__raw_writeq(V_SMB_ADDR(X1241_CCR_ADDRESS) | V_SMB_TT_RD1BYTE,
|
||||||
SMB_CSR(R_SMB_START));
|
SMB_CSR(R_SMB_START));
|
||||||
|
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
if (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_ERROR) {
|
if (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_ERROR) {
|
||||||
/* Clear error bit by writing a 1 */
|
/* Clear error bit by writing a 1 */
|
||||||
bus_writeq(M_SMB_ERROR, SMB_CSR(R_SMB_STATUS));
|
__raw_writeq(M_SMB_ERROR, SMB_CSR(R_SMB_STATUS));
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
return (bus_readq(SMB_CSR(R_SMB_DATA)) & 0xff);
|
return (__raw_readq(SMB_CSR(R_SMB_DATA)) & 0xff);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int xicor_write(uint8_t addr, int b)
|
static int xicor_write(uint8_t addr, int b)
|
||||||
{
|
{
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
bus_writeq(addr, SMB_CSR(R_SMB_CMD));
|
__raw_writeq(addr, SMB_CSR(R_SMB_CMD));
|
||||||
bus_writeq((addr & 0xff) | ((b & 0xff) << 8), SMB_CSR(R_SMB_DATA));
|
__raw_writeq((addr & 0xff) | ((b & 0xff) << 8), SMB_CSR(R_SMB_DATA));
|
||||||
bus_writeq(V_SMB_ADDR(X1241_CCR_ADDRESS) | V_SMB_TT_WR3BYTE,
|
__raw_writeq(V_SMB_ADDR(X1241_CCR_ADDRESS) | V_SMB_TT_WR3BYTE,
|
||||||
SMB_CSR(R_SMB_START));
|
SMB_CSR(R_SMB_START));
|
||||||
|
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
if (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_ERROR) {
|
if (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_ERROR) {
|
||||||
/* Clear error bit by writing a 1 */
|
/* Clear error bit by writing a 1 */
|
||||||
bus_writeq(M_SMB_ERROR, SMB_CSR(R_SMB_STATUS));
|
__raw_writeq(M_SMB_ERROR, SMB_CSR(R_SMB_STATUS));
|
||||||
return -1;
|
return -1;
|
||||||
} else {
|
} else {
|
||||||
return 0;
|
return 0;
|
||||||
|
|
|
@ -79,48 +79,48 @@ static unsigned int usec_bias = 0;
|
||||||
|
|
||||||
static int xicor_read(uint8_t addr)
|
static int xicor_read(uint8_t addr)
|
||||||
{
|
{
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
bus_writeq((addr >> 8) & 0x7, SMB_CSR(R_SMB_CMD));
|
__raw_writeq((addr >> 8) & 0x7, SMB_CSR(R_SMB_CMD));
|
||||||
bus_writeq((addr & 0xff), SMB_CSR(R_SMB_DATA));
|
__raw_writeq(addr & 0xff, SMB_CSR(R_SMB_DATA));
|
||||||
bus_writeq((V_SMB_ADDR(X1241_CCR_ADDRESS) | V_SMB_TT_WR2BYTE),
|
__raw_writeq(V_SMB_ADDR(X1241_CCR_ADDRESS) | V_SMB_TT_WR2BYTE,
|
||||||
SMB_CSR(R_SMB_START));
|
SMB_CSR(R_SMB_START));
|
||||||
|
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
bus_writeq((V_SMB_ADDR(X1241_CCR_ADDRESS) | V_SMB_TT_RD1BYTE),
|
__raw_writeq(V_SMB_ADDR(X1241_CCR_ADDRESS) | V_SMB_TT_RD1BYTE,
|
||||||
SMB_CSR(R_SMB_START));
|
SMB_CSR(R_SMB_START));
|
||||||
|
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
if (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_ERROR) {
|
if (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_ERROR) {
|
||||||
/* Clear error bit by writing a 1 */
|
/* Clear error bit by writing a 1 */
|
||||||
bus_writeq(M_SMB_ERROR, SMB_CSR(R_SMB_STATUS));
|
__raw_writeq(M_SMB_ERROR, SMB_CSR(R_SMB_STATUS));
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
return (bus_readq(SMB_CSR(R_SMB_DATA)) & 0xff);
|
return (__raw_readq(SMB_CSR(R_SMB_DATA)) & 0xff);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int xicor_write(uint8_t addr, int b)
|
static int xicor_write(uint8_t addr, int b)
|
||||||
{
|
{
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
bus_writeq(addr, SMB_CSR(R_SMB_CMD));
|
__raw_writeq(addr, SMB_CSR(R_SMB_CMD));
|
||||||
bus_writeq((addr & 0xff) | ((b & 0xff) << 8), SMB_CSR(R_SMB_DATA));
|
__raw_writeq((addr & 0xff) | ((b & 0xff) << 8), SMB_CSR(R_SMB_DATA));
|
||||||
bus_writeq(V_SMB_ADDR(X1241_CCR_ADDRESS) | V_SMB_TT_WR3BYTE,
|
__raw_writeq(V_SMB_ADDR(X1241_CCR_ADDRESS) | V_SMB_TT_WR3BYTE,
|
||||||
SMB_CSR(R_SMB_START));
|
SMB_CSR(R_SMB_START));
|
||||||
|
|
||||||
while (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
while (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_BUSY)
|
||||||
;
|
;
|
||||||
|
|
||||||
if (bus_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_ERROR) {
|
if (__raw_readq(SMB_CSR(R_SMB_STATUS)) & M_SMB_ERROR) {
|
||||||
/* Clear error bit by writing a 1 */
|
/* Clear error bit by writing a 1 */
|
||||||
bus_writeq(M_SMB_ERROR, SMB_CSR(R_SMB_STATUS));
|
__raw_writeq(M_SMB_ERROR, SMB_CSR(R_SMB_STATUS));
|
||||||
return -1;
|
return -1;
|
||||||
} else {
|
} else {
|
||||||
return 0;
|
return 0;
|
||||||
|
@ -228,8 +228,8 @@ void __init swarm_time_init(void)
|
||||||
/* Establish communication with the Xicor 1241 RTC */
|
/* Establish communication with the Xicor 1241 RTC */
|
||||||
/* XXXKW how do I share the SMBus with the I2C subsystem? */
|
/* XXXKW how do I share the SMBus with the I2C subsystem? */
|
||||||
|
|
||||||
bus_writeq(K_SMB_FREQ_400KHZ, SMB_CSR(R_SMB_FREQ));
|
__raw_writeq(K_SMB_FREQ_400KHZ, SMB_CSR(R_SMB_FREQ));
|
||||||
bus_writeq(0, SMB_CSR(R_SMB_CONTROL));
|
__raw_writeq(0, SMB_CSR(R_SMB_CONTROL));
|
||||||
|
|
||||||
if ((status = xicor_read(X1241REG_SR_RTCF)) < 0) {
|
if ((status = xicor_read(X1241REG_SR_RTCF)) < 0) {
|
||||||
printk("x1241: couldn't detect on SWARM SMBus 1\n");
|
printk("x1241: couldn't detect on SWARM SMBus 1\n");
|
||||||
|
|
|
@ -58,6 +58,6 @@ extern void prom_printf(char *fmt, ...);
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#define IOADDR(a) (IO_BASE + (a))
|
#define IOADDR(a) ((void *)(IO_BASE + (a)))
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
Loading…
Reference in New Issue