linux/arch/mips/loongson64/common/cs5536/cs5536_ohci.c
<<
>>
Prefs
   1/*
   2 * the OHCI Virtual Support Module of AMD CS5536
   3 *
   4 * Copyright (C) 2007 Lemote, Inc.
   5 * Author : jlliu, liujl@lemote.com
   6 *
   7 * Copyright (C) 2009 Lemote, Inc.
   8 * Author: Wu Zhangjin, wuzhangjin@gmail.com
   9 *
  10 * This program is free software; you can redistribute  it and/or modify it
  11 * under  the terms of  the GNU General  Public License as published by the
  12 * Free Software Foundation;  either version 2 of the  License, or (at your
  13 * option) any later version.
  14 */
  15
  16#include <cs5536/cs5536.h>
  17#include <cs5536/cs5536_pci.h>
  18
  19void pci_ohci_write_reg(int reg, u32 value)
  20{
  21        u32 hi = 0, lo = value;
  22
  23        switch (reg) {
  24        case PCI_COMMAND:
  25                _rdmsr(USB_MSR_REG(USB_OHCI), &hi, &lo);
  26                if (value & PCI_COMMAND_MASTER)
  27                        hi |= PCI_COMMAND_MASTER;
  28                else
  29                        hi &= ~PCI_COMMAND_MASTER;
  30
  31                if (value & PCI_COMMAND_MEMORY)
  32                        hi |= PCI_COMMAND_MEMORY;
  33                else
  34                        hi &= ~PCI_COMMAND_MEMORY;
  35                _wrmsr(USB_MSR_REG(USB_OHCI), hi, lo);
  36                break;
  37        case PCI_STATUS:
  38                if (value & PCI_STATUS_PARITY) {
  39                        _rdmsr(SB_MSR_REG(SB_ERROR), &hi, &lo);
  40                        if (lo & SB_PARE_ERR_FLAG) {
  41                                lo = (lo & 0x0000ffff) | SB_PARE_ERR_FLAG;
  42                                _wrmsr(SB_MSR_REG(SB_ERROR), hi, lo);
  43                        }
  44                }
  45                break;
  46        case PCI_BAR0_REG:
  47                if (value == PCI_BAR_RANGE_MASK) {
  48                        _rdmsr(GLCP_MSR_REG(GLCP_SOFT_COM), &hi, &lo);
  49                        lo |= SOFT_BAR_OHCI_FLAG;
  50                        _wrmsr(GLCP_MSR_REG(GLCP_SOFT_COM), hi, lo);
  51                } else if ((value & 0x01) == 0x00) {
  52                        _rdmsr(USB_MSR_REG(USB_OHCI), &hi, &lo);
  53                        lo = value;
  54                        _wrmsr(USB_MSR_REG(USB_OHCI), hi, lo);
  55
  56                        value &= 0xfffffff0;
  57                        hi = 0x40000000 | ((value & 0xff000000) >> 24);
  58                        lo = 0x000fffff | ((value & 0x00fff000) << 8);
  59                        _wrmsr(GLIU_MSR_REG(GLIU_P2D_BM3), hi, lo);
  60                }
  61                break;
  62        case PCI_OHCI_INT_REG:
  63                _rdmsr(DIVIL_MSR_REG(PIC_YSEL_LOW), &hi, &lo);
  64                lo &= ~(0xf << PIC_YSEL_LOW_USB_SHIFT);
  65                if (value)      /* enable all the usb interrupt in PIC */
  66                        lo |= (CS5536_USB_INTR << PIC_YSEL_LOW_USB_SHIFT);
  67                _wrmsr(DIVIL_MSR_REG(PIC_YSEL_LOW), hi, lo);
  68                break;
  69        default:
  70                break;
  71        }
  72}
  73
  74u32 pci_ohci_read_reg(int reg)
  75{
  76        u32 conf_data = 0;
  77        u32 hi, lo;
  78
  79        switch (reg) {
  80        case PCI_VENDOR_ID:
  81                conf_data =
  82                    CFG_PCI_VENDOR_ID(CS5536_OHCI_DEVICE_ID, CS5536_VENDOR_ID);
  83                break;
  84        case PCI_COMMAND:
  85                _rdmsr(USB_MSR_REG(USB_OHCI), &hi, &lo);
  86                if (hi & PCI_COMMAND_MASTER)
  87                        conf_data |= PCI_COMMAND_MASTER;
  88                if (hi & PCI_COMMAND_MEMORY)
  89                        conf_data |= PCI_COMMAND_MEMORY;
  90                break;
  91        case PCI_STATUS:
  92                conf_data |= PCI_STATUS_66MHZ;
  93                conf_data |= PCI_STATUS_FAST_BACK;
  94                _rdmsr(SB_MSR_REG(SB_ERROR), &hi, &lo);
  95                if (lo & SB_PARE_ERR_FLAG)
  96                        conf_data |= PCI_STATUS_PARITY;
  97                conf_data |= PCI_STATUS_DEVSEL_MEDIUM;
  98                break;
  99        case PCI_CLASS_REVISION:
 100                _rdmsr(USB_MSR_REG(USB_CAP), &hi, &lo);
 101                conf_data = lo & 0x000000ff;
 102                conf_data |= (CS5536_OHCI_CLASS_CODE << 8);
 103                break;
 104        case PCI_CACHE_LINE_SIZE:
 105                conf_data =
 106                    CFG_PCI_CACHE_LINE_SIZE(PCI_NORMAL_HEADER_TYPE,
 107                                            PCI_NORMAL_LATENCY_TIMER);
 108                break;
 109        case PCI_BAR0_REG:
 110                _rdmsr(GLCP_MSR_REG(GLCP_SOFT_COM), &hi, &lo);
 111                if (lo & SOFT_BAR_OHCI_FLAG) {
 112                        conf_data = CS5536_OHCI_RANGE |
 113                            PCI_BASE_ADDRESS_SPACE_MEMORY;
 114                        lo &= ~SOFT_BAR_OHCI_FLAG;
 115                        _wrmsr(GLCP_MSR_REG(GLCP_SOFT_COM), hi, lo);
 116                } else {
 117                        _rdmsr(USB_MSR_REG(USB_OHCI), &hi, &lo);
 118                        conf_data = lo & 0xffffff00;
 119                        conf_data &= ~0x0000000f;       /* 32bit mem */
 120                }
 121                break;
 122        case PCI_CARDBUS_CIS:
 123                conf_data = PCI_CARDBUS_CIS_POINTER;
 124                break;
 125        case PCI_SUBSYSTEM_VENDOR_ID:
 126                conf_data =
 127                    CFG_PCI_VENDOR_ID(CS5536_OHCI_SUB_ID, CS5536_SUB_VENDOR_ID);
 128                break;
 129        case PCI_ROM_ADDRESS:
 130                conf_data = PCI_EXPANSION_ROM_BAR;
 131                break;
 132        case PCI_CAPABILITY_LIST:
 133                conf_data = PCI_CAPLIST_USB_POINTER;
 134                break;
 135        case PCI_INTERRUPT_LINE:
 136                conf_data =
 137                    CFG_PCI_INTERRUPT_LINE(PCI_DEFAULT_PIN, CS5536_USB_INTR);
 138                break;
 139        case PCI_OHCI_INT_REG:
 140                _rdmsr(DIVIL_MSR_REG(PIC_YSEL_LOW), &hi, &lo);
 141                if ((lo & 0x00000f00) == CS5536_USB_INTR)
 142                        conf_data = 1;
 143                break;
 144        default:
 145                break;
 146        }
 147
 148        return conf_data;
 149}
 150