162306a36Sopenharmony_ci/* 262306a36Sopenharmony_ci * arch/m68k/mvme16x/config.c 362306a36Sopenharmony_ci * 462306a36Sopenharmony_ci * Copyright (C) 1995 Richard Hirst [richard@sleepie.demon.co.uk] 562306a36Sopenharmony_ci * 662306a36Sopenharmony_ci * Based on: 762306a36Sopenharmony_ci * 862306a36Sopenharmony_ci * linux/amiga/config.c 962306a36Sopenharmony_ci * 1062306a36Sopenharmony_ci * Copyright (C) 1993 Hamish Macdonald 1162306a36Sopenharmony_ci * 1262306a36Sopenharmony_ci * This file is subject to the terms and conditions of the GNU General Public 1362306a36Sopenharmony_ci * License. See the file README.legal in the main directory of this archive 1462306a36Sopenharmony_ci * for more details. 1562306a36Sopenharmony_ci */ 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_ci#include <linux/types.h> 1862306a36Sopenharmony_ci#include <linux/kernel.h> 1962306a36Sopenharmony_ci#include <linux/mm.h> 2062306a36Sopenharmony_ci#include <linux/seq_file.h> 2162306a36Sopenharmony_ci#include <linux/tty.h> 2262306a36Sopenharmony_ci#include <linux/clocksource.h> 2362306a36Sopenharmony_ci#include <linux/console.h> 2462306a36Sopenharmony_ci#include <linux/linkage.h> 2562306a36Sopenharmony_ci#include <linux/init.h> 2662306a36Sopenharmony_ci#include <linux/major.h> 2762306a36Sopenharmony_ci#include <linux/rtc.h> 2862306a36Sopenharmony_ci#include <linux/interrupt.h> 2962306a36Sopenharmony_ci#include <linux/module.h> 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_ci#include <asm/bootinfo.h> 3262306a36Sopenharmony_ci#include <asm/bootinfo-vme.h> 3362306a36Sopenharmony_ci#include <asm/byteorder.h> 3462306a36Sopenharmony_ci#include <asm/setup.h> 3562306a36Sopenharmony_ci#include <asm/irq.h> 3662306a36Sopenharmony_ci#include <asm/traps.h> 3762306a36Sopenharmony_ci#include <asm/machdep.h> 3862306a36Sopenharmony_ci#include <asm/mvme16xhw.h> 3962306a36Sopenharmony_ci#include <asm/config.h> 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_ciextern t_bdid mvme_bdid; 4262306a36Sopenharmony_ci 4362306a36Sopenharmony_cistatic MK48T08ptr_t volatile rtc = (MK48T08ptr_t)MVME_RTC_BASE; 4462306a36Sopenharmony_ci 4562306a36Sopenharmony_cistatic void mvme16x_get_model(char *model); 4662306a36Sopenharmony_ciextern void mvme16x_sched_init(void); 4762306a36Sopenharmony_ciextern int mvme16x_hwclk (int, struct rtc_time *); 4862306a36Sopenharmony_ciextern void mvme16x_reset (void); 4962306a36Sopenharmony_ci 5062306a36Sopenharmony_ciint bcd2int (unsigned char b); 5162306a36Sopenharmony_ci 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_ciunsigned short mvme16x_config; 5462306a36Sopenharmony_ciEXPORT_SYMBOL(mvme16x_config); 5562306a36Sopenharmony_ci 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_ciint __init mvme16x_parse_bootinfo(const struct bi_record *bi) 5862306a36Sopenharmony_ci{ 5962306a36Sopenharmony_ci uint16_t tag = be16_to_cpu(bi->tag); 6062306a36Sopenharmony_ci if (tag == BI_VME_TYPE || tag == BI_VME_BRDINFO) 6162306a36Sopenharmony_ci return 0; 6262306a36Sopenharmony_ci else 6362306a36Sopenharmony_ci return 1; 6462306a36Sopenharmony_ci} 6562306a36Sopenharmony_ci 6662306a36Sopenharmony_civoid mvme16x_reset(void) 6762306a36Sopenharmony_ci{ 6862306a36Sopenharmony_ci pr_info("\r\n\nCalled mvme16x_reset\r\n" 6962306a36Sopenharmony_ci "\r\r\r\r\r\r\r\r\r\r\r\r\r\r\r\r\r\r"); 7062306a36Sopenharmony_ci /* The string of returns is to delay the reset until the whole 7162306a36Sopenharmony_ci * message is output. Assert reset bit in GCSR */ 7262306a36Sopenharmony_ci *(volatile char *)0xfff40107 = 0x80; 7362306a36Sopenharmony_ci} 7462306a36Sopenharmony_ci 7562306a36Sopenharmony_cistatic void mvme16x_get_model(char *model) 7662306a36Sopenharmony_ci{ 7762306a36Sopenharmony_ci p_bdid p = &mvme_bdid; 7862306a36Sopenharmony_ci char suf[4]; 7962306a36Sopenharmony_ci 8062306a36Sopenharmony_ci suf[1] = p->brdsuffix[0]; 8162306a36Sopenharmony_ci suf[2] = p->brdsuffix[1]; 8262306a36Sopenharmony_ci suf[3] = '\0'; 8362306a36Sopenharmony_ci suf[0] = suf[1] ? '-' : '\0'; 8462306a36Sopenharmony_ci 8562306a36Sopenharmony_ci sprintf(model, "Motorola MVME%x%s", be16_to_cpu(p->brdno), suf); 8662306a36Sopenharmony_ci} 8762306a36Sopenharmony_ci 8862306a36Sopenharmony_ci 8962306a36Sopenharmony_cistatic void mvme16x_get_hardware_list(struct seq_file *m) 9062306a36Sopenharmony_ci{ 9162306a36Sopenharmony_ci uint16_t brdno = be16_to_cpu(mvme_bdid.brdno); 9262306a36Sopenharmony_ci 9362306a36Sopenharmony_ci if (brdno == 0x0162 || brdno == 0x0172) 9462306a36Sopenharmony_ci { 9562306a36Sopenharmony_ci unsigned char rev = *(unsigned char *)MVME162_VERSION_REG; 9662306a36Sopenharmony_ci 9762306a36Sopenharmony_ci seq_printf (m, "VMEchip2 %spresent\n", 9862306a36Sopenharmony_ci rev & MVME16x_CONFIG_NO_VMECHIP2 ? "NOT " : ""); 9962306a36Sopenharmony_ci seq_printf (m, "SCSI interface %spresent\n", 10062306a36Sopenharmony_ci rev & MVME16x_CONFIG_NO_SCSICHIP ? "NOT " : ""); 10162306a36Sopenharmony_ci seq_printf (m, "Ethernet i/f %spresent\n", 10262306a36Sopenharmony_ci rev & MVME16x_CONFIG_NO_ETHERNET ? "NOT " : ""); 10362306a36Sopenharmony_ci } 10462306a36Sopenharmony_ci} 10562306a36Sopenharmony_ci 10662306a36Sopenharmony_ci/* 10762306a36Sopenharmony_ci * This function is called during kernel startup to initialize 10862306a36Sopenharmony_ci * the mvme16x IRQ handling routines. Should probably ensure 10962306a36Sopenharmony_ci * that the base vectors for the VMEChip2 and PCCChip2 are valid. 11062306a36Sopenharmony_ci */ 11162306a36Sopenharmony_ci 11262306a36Sopenharmony_cistatic void __init mvme16x_init_IRQ (void) 11362306a36Sopenharmony_ci{ 11462306a36Sopenharmony_ci m68k_setup_user_interrupt(VEC_USER, 192); 11562306a36Sopenharmony_ci} 11662306a36Sopenharmony_ci 11762306a36Sopenharmony_ci#define PCC2CHIP (0xfff42000) 11862306a36Sopenharmony_ci#define PCCSCCMICR (PCC2CHIP + 0x1d) 11962306a36Sopenharmony_ci#define PCCSCCTICR (PCC2CHIP + 0x1e) 12062306a36Sopenharmony_ci#define PCCSCCRICR (PCC2CHIP + 0x1f) 12162306a36Sopenharmony_ci#define PCCTPIACKR (PCC2CHIP + 0x25) 12262306a36Sopenharmony_ci 12362306a36Sopenharmony_ci#ifdef CONFIG_EARLY_PRINTK 12462306a36Sopenharmony_ci 12562306a36Sopenharmony_ci/**** cd2401 registers ****/ 12662306a36Sopenharmony_ci#define CD2401_ADDR (0xfff45000) 12762306a36Sopenharmony_ci 12862306a36Sopenharmony_ci#define CyGFRCR (0x81) 12962306a36Sopenharmony_ci#define CyCCR (0x13) 13062306a36Sopenharmony_ci#define CyCLR_CHAN (0x40) 13162306a36Sopenharmony_ci#define CyINIT_CHAN (0x20) 13262306a36Sopenharmony_ci#define CyCHIP_RESET (0x10) 13362306a36Sopenharmony_ci#define CyENB_XMTR (0x08) 13462306a36Sopenharmony_ci#define CyDIS_XMTR (0x04) 13562306a36Sopenharmony_ci#define CyENB_RCVR (0x02) 13662306a36Sopenharmony_ci#define CyDIS_RCVR (0x01) 13762306a36Sopenharmony_ci#define CyCAR (0xee) 13862306a36Sopenharmony_ci#define CyIER (0x11) 13962306a36Sopenharmony_ci#define CyMdmCh (0x80) 14062306a36Sopenharmony_ci#define CyRxExc (0x20) 14162306a36Sopenharmony_ci#define CyRxData (0x08) 14262306a36Sopenharmony_ci#define CyTxMpty (0x02) 14362306a36Sopenharmony_ci#define CyTxRdy (0x01) 14462306a36Sopenharmony_ci#define CyLICR (0x26) 14562306a36Sopenharmony_ci#define CyRISR (0x89) 14662306a36Sopenharmony_ci#define CyTIMEOUT (0x80) 14762306a36Sopenharmony_ci#define CySPECHAR (0x70) 14862306a36Sopenharmony_ci#define CyOVERRUN (0x08) 14962306a36Sopenharmony_ci#define CyPARITY (0x04) 15062306a36Sopenharmony_ci#define CyFRAME (0x02) 15162306a36Sopenharmony_ci#define CyBREAK (0x01) 15262306a36Sopenharmony_ci#define CyREOIR (0x84) 15362306a36Sopenharmony_ci#define CyTEOIR (0x85) 15462306a36Sopenharmony_ci#define CyMEOIR (0x86) 15562306a36Sopenharmony_ci#define CyNOTRANS (0x08) 15662306a36Sopenharmony_ci#define CyRFOC (0x30) 15762306a36Sopenharmony_ci#define CyRDR (0xf8) 15862306a36Sopenharmony_ci#define CyTDR (0xf8) 15962306a36Sopenharmony_ci#define CyMISR (0x8b) 16062306a36Sopenharmony_ci#define CyRISR (0x89) 16162306a36Sopenharmony_ci#define CyTISR (0x8a) 16262306a36Sopenharmony_ci#define CyMSVR1 (0xde) 16362306a36Sopenharmony_ci#define CyMSVR2 (0xdf) 16462306a36Sopenharmony_ci#define CyDSR (0x80) 16562306a36Sopenharmony_ci#define CyDCD (0x40) 16662306a36Sopenharmony_ci#define CyCTS (0x20) 16762306a36Sopenharmony_ci#define CyDTR (0x02) 16862306a36Sopenharmony_ci#define CyRTS (0x01) 16962306a36Sopenharmony_ci#define CyRTPRL (0x25) 17062306a36Sopenharmony_ci#define CyRTPRH (0x24) 17162306a36Sopenharmony_ci#define CyCOR1 (0x10) 17262306a36Sopenharmony_ci#define CyPARITY_NONE (0x00) 17362306a36Sopenharmony_ci#define CyPARITY_E (0x40) 17462306a36Sopenharmony_ci#define CyPARITY_O (0xC0) 17562306a36Sopenharmony_ci#define Cy_5_BITS (0x04) 17662306a36Sopenharmony_ci#define Cy_6_BITS (0x05) 17762306a36Sopenharmony_ci#define Cy_7_BITS (0x06) 17862306a36Sopenharmony_ci#define Cy_8_BITS (0x07) 17962306a36Sopenharmony_ci#define CyCOR2 (0x17) 18062306a36Sopenharmony_ci#define CyETC (0x20) 18162306a36Sopenharmony_ci#define CyCtsAE (0x02) 18262306a36Sopenharmony_ci#define CyCOR3 (0x16) 18362306a36Sopenharmony_ci#define Cy_1_STOP (0x02) 18462306a36Sopenharmony_ci#define Cy_2_STOP (0x04) 18562306a36Sopenharmony_ci#define CyCOR4 (0x15) 18662306a36Sopenharmony_ci#define CyREC_FIFO (0x0F) /* Receive FIFO threshold */ 18762306a36Sopenharmony_ci#define CyCOR5 (0x14) 18862306a36Sopenharmony_ci#define CyCOR6 (0x18) 18962306a36Sopenharmony_ci#define CyCOR7 (0x07) 19062306a36Sopenharmony_ci#define CyRBPR (0xcb) 19162306a36Sopenharmony_ci#define CyRCOR (0xc8) 19262306a36Sopenharmony_ci#define CyTBPR (0xc3) 19362306a36Sopenharmony_ci#define CyTCOR (0xc0) 19462306a36Sopenharmony_ci#define CySCHR1 (0x1f) 19562306a36Sopenharmony_ci#define CySCHR2 (0x1e) 19662306a36Sopenharmony_ci#define CyTPR (0xda) 19762306a36Sopenharmony_ci#define CyPILR1 (0xe3) 19862306a36Sopenharmony_ci#define CyPILR2 (0xe0) 19962306a36Sopenharmony_ci#define CyPILR3 (0xe1) 20062306a36Sopenharmony_ci#define CyCMR (0x1b) 20162306a36Sopenharmony_ci#define CyASYNC (0x02) 20262306a36Sopenharmony_ci#define CyLICR (0x26) 20362306a36Sopenharmony_ci#define CyLIVR (0x09) 20462306a36Sopenharmony_ci#define CySCRL (0x23) 20562306a36Sopenharmony_ci#define CySCRH (0x22) 20662306a36Sopenharmony_ci#define CyTFTC (0x80) 20762306a36Sopenharmony_ci 20862306a36Sopenharmony_civoid mvme16x_cons_write(struct console *co, const char *str, unsigned count) 20962306a36Sopenharmony_ci{ 21062306a36Sopenharmony_ci volatile unsigned char *base_addr = (u_char *)CD2401_ADDR; 21162306a36Sopenharmony_ci volatile u_char sink; 21262306a36Sopenharmony_ci u_char ier; 21362306a36Sopenharmony_ci int port; 21462306a36Sopenharmony_ci u_char do_lf = 0; 21562306a36Sopenharmony_ci int i = 0; 21662306a36Sopenharmony_ci 21762306a36Sopenharmony_ci /* Ensure transmitter is enabled! */ 21862306a36Sopenharmony_ci 21962306a36Sopenharmony_ci port = 0; 22062306a36Sopenharmony_ci base_addr[CyCAR] = (u_char)port; 22162306a36Sopenharmony_ci while (base_addr[CyCCR]) 22262306a36Sopenharmony_ci ; 22362306a36Sopenharmony_ci base_addr[CyCCR] = CyENB_XMTR; 22462306a36Sopenharmony_ci 22562306a36Sopenharmony_ci ier = base_addr[CyIER]; 22662306a36Sopenharmony_ci base_addr[CyIER] = CyTxMpty; 22762306a36Sopenharmony_ci 22862306a36Sopenharmony_ci while (1) { 22962306a36Sopenharmony_ci if (in_8(PCCSCCTICR) & 0x20) 23062306a36Sopenharmony_ci { 23162306a36Sopenharmony_ci /* We have a Tx int. Acknowledge it */ 23262306a36Sopenharmony_ci sink = in_8(PCCTPIACKR); 23362306a36Sopenharmony_ci if ((base_addr[CyLICR] >> 2) == port) { 23462306a36Sopenharmony_ci if (i == count) { 23562306a36Sopenharmony_ci /* Last char of string is now output */ 23662306a36Sopenharmony_ci base_addr[CyTEOIR] = CyNOTRANS; 23762306a36Sopenharmony_ci break; 23862306a36Sopenharmony_ci } 23962306a36Sopenharmony_ci if (do_lf) { 24062306a36Sopenharmony_ci base_addr[CyTDR] = '\n'; 24162306a36Sopenharmony_ci str++; 24262306a36Sopenharmony_ci i++; 24362306a36Sopenharmony_ci do_lf = 0; 24462306a36Sopenharmony_ci } 24562306a36Sopenharmony_ci else if (*str == '\n') { 24662306a36Sopenharmony_ci base_addr[CyTDR] = '\r'; 24762306a36Sopenharmony_ci do_lf = 1; 24862306a36Sopenharmony_ci } 24962306a36Sopenharmony_ci else { 25062306a36Sopenharmony_ci base_addr[CyTDR] = *str++; 25162306a36Sopenharmony_ci i++; 25262306a36Sopenharmony_ci } 25362306a36Sopenharmony_ci base_addr[CyTEOIR] = 0; 25462306a36Sopenharmony_ci } 25562306a36Sopenharmony_ci else 25662306a36Sopenharmony_ci base_addr[CyTEOIR] = CyNOTRANS; 25762306a36Sopenharmony_ci } 25862306a36Sopenharmony_ci } 25962306a36Sopenharmony_ci 26062306a36Sopenharmony_ci base_addr[CyIER] = ier; 26162306a36Sopenharmony_ci} 26262306a36Sopenharmony_ci 26362306a36Sopenharmony_ci#endif 26462306a36Sopenharmony_ci 26562306a36Sopenharmony_civoid __init config_mvme16x(void) 26662306a36Sopenharmony_ci{ 26762306a36Sopenharmony_ci p_bdid p = &mvme_bdid; 26862306a36Sopenharmony_ci char id[40]; 26962306a36Sopenharmony_ci uint16_t brdno = be16_to_cpu(p->brdno); 27062306a36Sopenharmony_ci 27162306a36Sopenharmony_ci mach_sched_init = mvme16x_sched_init; 27262306a36Sopenharmony_ci mach_init_IRQ = mvme16x_init_IRQ; 27362306a36Sopenharmony_ci mach_hwclk = mvme16x_hwclk; 27462306a36Sopenharmony_ci mach_reset = mvme16x_reset; 27562306a36Sopenharmony_ci mach_get_model = mvme16x_get_model; 27662306a36Sopenharmony_ci mach_get_hardware_list = mvme16x_get_hardware_list; 27762306a36Sopenharmony_ci 27862306a36Sopenharmony_ci /* Report board revision */ 27962306a36Sopenharmony_ci 28062306a36Sopenharmony_ci if (strncmp("BDID", p->bdid, 4)) 28162306a36Sopenharmony_ci { 28262306a36Sopenharmony_ci pr_crit("Bug call .BRD_ID returned garbage - giving up\n"); 28362306a36Sopenharmony_ci while (1) 28462306a36Sopenharmony_ci ; 28562306a36Sopenharmony_ci } 28662306a36Sopenharmony_ci /* Board type is only set by newer versions of vmelilo/tftplilo */ 28762306a36Sopenharmony_ci if (vme_brdtype == 0) 28862306a36Sopenharmony_ci vme_brdtype = brdno; 28962306a36Sopenharmony_ci 29062306a36Sopenharmony_ci mvme16x_get_model(id); 29162306a36Sopenharmony_ci pr_info("BRD_ID: %s BUG %x.%x %02x/%02x/%02x\n", id, p->rev >> 4, 29262306a36Sopenharmony_ci p->rev & 0xf, p->yr, p->mth, p->day); 29362306a36Sopenharmony_ci if (brdno == 0x0162 || brdno == 0x172) 29462306a36Sopenharmony_ci { 29562306a36Sopenharmony_ci unsigned char rev = *(unsigned char *)MVME162_VERSION_REG; 29662306a36Sopenharmony_ci 29762306a36Sopenharmony_ci mvme16x_config = rev | MVME16x_CONFIG_GOT_SCCA; 29862306a36Sopenharmony_ci 29962306a36Sopenharmony_ci pr_info("MVME%x Hardware status:\n", brdno); 30062306a36Sopenharmony_ci pr_info(" CPU Type 68%s040\n", 30162306a36Sopenharmony_ci rev & MVME16x_CONFIG_GOT_FPU ? "" : "LC"); 30262306a36Sopenharmony_ci pr_info(" CPU clock %dMHz\n", 30362306a36Sopenharmony_ci rev & MVME16x_CONFIG_SPEED_32 ? 32 : 25); 30462306a36Sopenharmony_ci pr_info(" VMEchip2 %spresent\n", 30562306a36Sopenharmony_ci rev & MVME16x_CONFIG_NO_VMECHIP2 ? "NOT " : ""); 30662306a36Sopenharmony_ci pr_info(" SCSI interface %spresent\n", 30762306a36Sopenharmony_ci rev & MVME16x_CONFIG_NO_SCSICHIP ? "NOT " : ""); 30862306a36Sopenharmony_ci pr_info(" Ethernet interface %spresent\n", 30962306a36Sopenharmony_ci rev & MVME16x_CONFIG_NO_ETHERNET ? "NOT " : ""); 31062306a36Sopenharmony_ci } 31162306a36Sopenharmony_ci else 31262306a36Sopenharmony_ci { 31362306a36Sopenharmony_ci mvme16x_config = MVME16x_CONFIG_GOT_LP | MVME16x_CONFIG_GOT_CD2401; 31462306a36Sopenharmony_ci } 31562306a36Sopenharmony_ci} 31662306a36Sopenharmony_ci 31762306a36Sopenharmony_cistatic irqreturn_t mvme16x_abort_int (int irq, void *dev_id) 31862306a36Sopenharmony_ci{ 31962306a36Sopenharmony_ci unsigned long *new = (unsigned long *)vectors; 32062306a36Sopenharmony_ci unsigned long *old = (unsigned long *)0xffe00000; 32162306a36Sopenharmony_ci volatile unsigned char uc, *ucp; 32262306a36Sopenharmony_ci uint16_t brdno = be16_to_cpu(mvme_bdid.brdno); 32362306a36Sopenharmony_ci 32462306a36Sopenharmony_ci if (brdno == 0x0162 || brdno == 0x172) 32562306a36Sopenharmony_ci { 32662306a36Sopenharmony_ci ucp = (volatile unsigned char *)0xfff42043; 32762306a36Sopenharmony_ci uc = *ucp | 8; 32862306a36Sopenharmony_ci *ucp = uc; 32962306a36Sopenharmony_ci } 33062306a36Sopenharmony_ci else 33162306a36Sopenharmony_ci { 33262306a36Sopenharmony_ci *(volatile unsigned long *)0xfff40074 = 0x40000000; 33362306a36Sopenharmony_ci } 33462306a36Sopenharmony_ci *(new+4) = *(old+4); /* Illegal instruction */ 33562306a36Sopenharmony_ci *(new+9) = *(old+9); /* Trace */ 33662306a36Sopenharmony_ci *(new+47) = *(old+47); /* Trap #15 */ 33762306a36Sopenharmony_ci 33862306a36Sopenharmony_ci if (brdno == 0x0162 || brdno == 0x172) 33962306a36Sopenharmony_ci *(new+0x5e) = *(old+0x5e); /* ABORT switch */ 34062306a36Sopenharmony_ci else 34162306a36Sopenharmony_ci *(new+0x6e) = *(old+0x6e); /* ABORT switch */ 34262306a36Sopenharmony_ci return IRQ_HANDLED; 34362306a36Sopenharmony_ci} 34462306a36Sopenharmony_ci 34562306a36Sopenharmony_cistatic u64 mvme16x_read_clk(struct clocksource *cs); 34662306a36Sopenharmony_ci 34762306a36Sopenharmony_cistatic struct clocksource mvme16x_clk = { 34862306a36Sopenharmony_ci .name = "pcc", 34962306a36Sopenharmony_ci .rating = 250, 35062306a36Sopenharmony_ci .read = mvme16x_read_clk, 35162306a36Sopenharmony_ci .mask = CLOCKSOURCE_MASK(32), 35262306a36Sopenharmony_ci .flags = CLOCK_SOURCE_IS_CONTINUOUS, 35362306a36Sopenharmony_ci}; 35462306a36Sopenharmony_ci 35562306a36Sopenharmony_cistatic u32 clk_total; 35662306a36Sopenharmony_ci 35762306a36Sopenharmony_ci#define PCC_TIMER_CLOCK_FREQ 1000000 35862306a36Sopenharmony_ci#define PCC_TIMER_CYCLES (PCC_TIMER_CLOCK_FREQ / HZ) 35962306a36Sopenharmony_ci 36062306a36Sopenharmony_ci#define PCCTCMP1 (PCC2CHIP + 0x04) 36162306a36Sopenharmony_ci#define PCCTCNT1 (PCC2CHIP + 0x08) 36262306a36Sopenharmony_ci#define PCCTOVR1 (PCC2CHIP + 0x17) 36362306a36Sopenharmony_ci#define PCCTIC1 (PCC2CHIP + 0x1b) 36462306a36Sopenharmony_ci 36562306a36Sopenharmony_ci#define PCCTOVR1_TIC_EN 0x01 36662306a36Sopenharmony_ci#define PCCTOVR1_COC_EN 0x02 36762306a36Sopenharmony_ci#define PCCTOVR1_OVR_CLR 0x04 36862306a36Sopenharmony_ci 36962306a36Sopenharmony_ci#define PCCTIC1_INT_LEVEL 6 37062306a36Sopenharmony_ci#define PCCTIC1_INT_CLR 0x08 37162306a36Sopenharmony_ci#define PCCTIC1_INT_EN 0x10 37262306a36Sopenharmony_ci 37362306a36Sopenharmony_cistatic irqreturn_t mvme16x_timer_int (int irq, void *dev_id) 37462306a36Sopenharmony_ci{ 37562306a36Sopenharmony_ci unsigned long flags; 37662306a36Sopenharmony_ci 37762306a36Sopenharmony_ci local_irq_save(flags); 37862306a36Sopenharmony_ci out_8(PCCTOVR1, PCCTOVR1_OVR_CLR | PCCTOVR1_TIC_EN | PCCTOVR1_COC_EN); 37962306a36Sopenharmony_ci out_8(PCCTIC1, PCCTIC1_INT_EN | PCCTIC1_INT_CLR | PCCTIC1_INT_LEVEL); 38062306a36Sopenharmony_ci clk_total += PCC_TIMER_CYCLES; 38162306a36Sopenharmony_ci legacy_timer_tick(1); 38262306a36Sopenharmony_ci local_irq_restore(flags); 38362306a36Sopenharmony_ci 38462306a36Sopenharmony_ci return IRQ_HANDLED; 38562306a36Sopenharmony_ci} 38662306a36Sopenharmony_ci 38762306a36Sopenharmony_civoid mvme16x_sched_init(void) 38862306a36Sopenharmony_ci{ 38962306a36Sopenharmony_ci uint16_t brdno = be16_to_cpu(mvme_bdid.brdno); 39062306a36Sopenharmony_ci int irq; 39162306a36Sopenharmony_ci 39262306a36Sopenharmony_ci /* Using PCCchip2 or MC2 chip tick timer 1 */ 39362306a36Sopenharmony_ci if (request_irq(MVME16x_IRQ_TIMER, mvme16x_timer_int, IRQF_TIMER, "timer", 39462306a36Sopenharmony_ci NULL)) 39562306a36Sopenharmony_ci panic ("Couldn't register timer int"); 39662306a36Sopenharmony_ci 39762306a36Sopenharmony_ci out_be32(PCCTCNT1, 0); 39862306a36Sopenharmony_ci out_be32(PCCTCMP1, PCC_TIMER_CYCLES); 39962306a36Sopenharmony_ci out_8(PCCTOVR1, PCCTOVR1_OVR_CLR | PCCTOVR1_TIC_EN | PCCTOVR1_COC_EN); 40062306a36Sopenharmony_ci out_8(PCCTIC1, PCCTIC1_INT_EN | PCCTIC1_INT_CLR | PCCTIC1_INT_LEVEL); 40162306a36Sopenharmony_ci 40262306a36Sopenharmony_ci clocksource_register_hz(&mvme16x_clk, PCC_TIMER_CLOCK_FREQ); 40362306a36Sopenharmony_ci 40462306a36Sopenharmony_ci if (brdno == 0x0162 || brdno == 0x172) 40562306a36Sopenharmony_ci irq = MVME162_IRQ_ABORT; 40662306a36Sopenharmony_ci else 40762306a36Sopenharmony_ci irq = MVME167_IRQ_ABORT; 40862306a36Sopenharmony_ci if (request_irq(irq, mvme16x_abort_int, 0, 40962306a36Sopenharmony_ci "abort", mvme16x_abort_int)) 41062306a36Sopenharmony_ci panic ("Couldn't register abort int"); 41162306a36Sopenharmony_ci} 41262306a36Sopenharmony_ci 41362306a36Sopenharmony_cistatic u64 mvme16x_read_clk(struct clocksource *cs) 41462306a36Sopenharmony_ci{ 41562306a36Sopenharmony_ci unsigned long flags; 41662306a36Sopenharmony_ci u8 overflow, tmp; 41762306a36Sopenharmony_ci u32 ticks; 41862306a36Sopenharmony_ci 41962306a36Sopenharmony_ci local_irq_save(flags); 42062306a36Sopenharmony_ci tmp = in_8(PCCTOVR1) >> 4; 42162306a36Sopenharmony_ci ticks = in_be32(PCCTCNT1); 42262306a36Sopenharmony_ci overflow = in_8(PCCTOVR1) >> 4; 42362306a36Sopenharmony_ci if (overflow != tmp) 42462306a36Sopenharmony_ci ticks = in_be32(PCCTCNT1); 42562306a36Sopenharmony_ci ticks += overflow * PCC_TIMER_CYCLES; 42662306a36Sopenharmony_ci ticks += clk_total; 42762306a36Sopenharmony_ci local_irq_restore(flags); 42862306a36Sopenharmony_ci 42962306a36Sopenharmony_ci return ticks; 43062306a36Sopenharmony_ci} 43162306a36Sopenharmony_ci 43262306a36Sopenharmony_ciint bcd2int (unsigned char b) 43362306a36Sopenharmony_ci{ 43462306a36Sopenharmony_ci return ((b>>4)*10 + (b&15)); 43562306a36Sopenharmony_ci} 43662306a36Sopenharmony_ci 43762306a36Sopenharmony_ciint mvme16x_hwclk(int op, struct rtc_time *t) 43862306a36Sopenharmony_ci{ 43962306a36Sopenharmony_ci if (!op) { 44062306a36Sopenharmony_ci rtc->ctrl = RTC_READ; 44162306a36Sopenharmony_ci t->tm_year = bcd2int (rtc->bcd_year); 44262306a36Sopenharmony_ci t->tm_mon = bcd2int(rtc->bcd_mth) - 1; 44362306a36Sopenharmony_ci t->tm_mday = bcd2int (rtc->bcd_dom); 44462306a36Sopenharmony_ci t->tm_hour = bcd2int (rtc->bcd_hr); 44562306a36Sopenharmony_ci t->tm_min = bcd2int (rtc->bcd_min); 44662306a36Sopenharmony_ci t->tm_sec = bcd2int (rtc->bcd_sec); 44762306a36Sopenharmony_ci rtc->ctrl = 0; 44862306a36Sopenharmony_ci if (t->tm_year < 70) 44962306a36Sopenharmony_ci t->tm_year += 100; 45062306a36Sopenharmony_ci } else { 45162306a36Sopenharmony_ci /* FIXME Setting the time is not yet supported */ 45262306a36Sopenharmony_ci return -EOPNOTSUPP; 45362306a36Sopenharmony_ci } 45462306a36Sopenharmony_ci return 0; 45562306a36Sopenharmony_ci} 456