mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2025-01-15 10:24:44 +08:00
2874c5fd28
Based on 1 normalized pattern(s): this program is free software you can redistribute it and or modify it under the terms of the gnu general public license as published by the free software foundation either version 2 of the license or at your option any later version extracted by the scancode license scanner the SPDX license identifier GPL-2.0-or-later has been chosen to replace the boilerplate/reference in 3029 file(s). Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Reviewed-by: Allison Randal <allison@lohutok.net> Cc: linux-spdx@vger.kernel.org Link: https://lkml.kernel.org/r/20190527070032.746973796@linutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
189 lines
4.6 KiB
C
189 lines
4.6 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* the IDE Virtual Support Module of AMD CS5536
|
|
*
|
|
* Copyright (C) 2007 Lemote, Inc.
|
|
* Author : jlliu, liujl@lemote.com
|
|
*
|
|
* Copyright (C) 2009 Lemote, Inc.
|
|
* Author: Wu Zhangjin, wuzhangjin@gmail.com
|
|
*/
|
|
|
|
#include <cs5536/cs5536.h>
|
|
#include <cs5536/cs5536_pci.h>
|
|
|
|
void pci_ide_write_reg(int reg, u32 value)
|
|
{
|
|
u32 hi = 0, lo = value;
|
|
|
|
switch (reg) {
|
|
case PCI_COMMAND:
|
|
_rdmsr(GLIU_MSR_REG(GLIU_PAE), &hi, &lo);
|
|
if (value & PCI_COMMAND_MASTER)
|
|
lo |= (0x03 << 4);
|
|
else
|
|
lo &= ~(0x03 << 4);
|
|
_wrmsr(GLIU_MSR_REG(GLIU_PAE), hi, lo);
|
|
break;
|
|
case PCI_STATUS:
|
|
if (value & PCI_STATUS_PARITY) {
|
|
_rdmsr(SB_MSR_REG(SB_ERROR), &hi, &lo);
|
|
if (lo & SB_PARE_ERR_FLAG) {
|
|
lo = (lo & 0x0000ffff) | SB_PARE_ERR_FLAG;
|
|
_wrmsr(SB_MSR_REG(SB_ERROR), hi, lo);
|
|
}
|
|
}
|
|
break;
|
|
case PCI_CACHE_LINE_SIZE:
|
|
value &= 0x0000ff00;
|
|
_rdmsr(SB_MSR_REG(SB_CTRL), &hi, &lo);
|
|
hi &= 0xffffff00;
|
|
hi |= (value >> 8);
|
|
_wrmsr(SB_MSR_REG(SB_CTRL), hi, lo);
|
|
break;
|
|
case PCI_BAR4_REG:
|
|
if (value == PCI_BAR_RANGE_MASK) {
|
|
_rdmsr(GLCP_MSR_REG(GLCP_SOFT_COM), &hi, &lo);
|
|
lo |= SOFT_BAR_IDE_FLAG;
|
|
_wrmsr(GLCP_MSR_REG(GLCP_SOFT_COM), hi, lo);
|
|
} else if (value & 0x01) {
|
|
_rdmsr(IDE_MSR_REG(IDE_IO_BAR), &hi, &lo);
|
|
lo = (value & 0xfffffff0) | 0x1;
|
|
_wrmsr(IDE_MSR_REG(IDE_IO_BAR), hi, lo);
|
|
|
|
value &= 0xfffffffc;
|
|
hi = 0x60000000 | ((value & 0x000ff000) >> 12);
|
|
lo = 0x000ffff0 | ((value & 0x00000fff) << 20);
|
|
_wrmsr(GLIU_MSR_REG(GLIU_IOD_BM2), hi, lo);
|
|
}
|
|
break;
|
|
case PCI_IDE_CFG_REG:
|
|
if (value == CS5536_IDE_FLASH_SIGNATURE) {
|
|
_rdmsr(DIVIL_MSR_REG(DIVIL_BALL_OPTS), &hi, &lo);
|
|
lo |= 0x01;
|
|
_wrmsr(DIVIL_MSR_REG(DIVIL_BALL_OPTS), hi, lo);
|
|
} else {
|
|
_rdmsr(IDE_MSR_REG(IDE_CFG), &hi, &lo);
|
|
lo = value;
|
|
_wrmsr(IDE_MSR_REG(IDE_CFG), hi, lo);
|
|
}
|
|
break;
|
|
case PCI_IDE_DTC_REG:
|
|
_rdmsr(IDE_MSR_REG(IDE_DTC), &hi, &lo);
|
|
lo = value;
|
|
_wrmsr(IDE_MSR_REG(IDE_DTC), hi, lo);
|
|
break;
|
|
case PCI_IDE_CAST_REG:
|
|
_rdmsr(IDE_MSR_REG(IDE_CAST), &hi, &lo);
|
|
lo = value;
|
|
_wrmsr(IDE_MSR_REG(IDE_CAST), hi, lo);
|
|
break;
|
|
case PCI_IDE_ETC_REG:
|
|
_rdmsr(IDE_MSR_REG(IDE_ETC), &hi, &lo);
|
|
lo = value;
|
|
_wrmsr(IDE_MSR_REG(IDE_ETC), hi, lo);
|
|
break;
|
|
case PCI_IDE_PM_REG:
|
|
_rdmsr(IDE_MSR_REG(IDE_INTERNAL_PM), &hi, &lo);
|
|
lo = value;
|
|
_wrmsr(IDE_MSR_REG(IDE_INTERNAL_PM), hi, lo);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
u32 pci_ide_read_reg(int reg)
|
|
{
|
|
u32 conf_data = 0;
|
|
u32 hi, lo;
|
|
|
|
switch (reg) {
|
|
case PCI_VENDOR_ID:
|
|
conf_data =
|
|
CFG_PCI_VENDOR_ID(CS5536_IDE_DEVICE_ID, CS5536_VENDOR_ID);
|
|
break;
|
|
case PCI_COMMAND:
|
|
_rdmsr(IDE_MSR_REG(IDE_IO_BAR), &hi, &lo);
|
|
if (lo & 0xfffffff0)
|
|
conf_data |= PCI_COMMAND_IO;
|
|
_rdmsr(GLIU_MSR_REG(GLIU_PAE), &hi, &lo);
|
|
if ((lo & 0x30) == 0x30)
|
|
conf_data |= PCI_COMMAND_MASTER;
|
|
break;
|
|
case PCI_STATUS:
|
|
conf_data |= PCI_STATUS_66MHZ;
|
|
conf_data |= PCI_STATUS_FAST_BACK;
|
|
_rdmsr(SB_MSR_REG(SB_ERROR), &hi, &lo);
|
|
if (lo & SB_PARE_ERR_FLAG)
|
|
conf_data |= PCI_STATUS_PARITY;
|
|
conf_data |= PCI_STATUS_DEVSEL_MEDIUM;
|
|
break;
|
|
case PCI_CLASS_REVISION:
|
|
_rdmsr(IDE_MSR_REG(IDE_CAP), &hi, &lo);
|
|
conf_data = lo & 0x000000ff;
|
|
conf_data |= (CS5536_IDE_CLASS_CODE << 8);
|
|
break;
|
|
case PCI_CACHE_LINE_SIZE:
|
|
_rdmsr(SB_MSR_REG(SB_CTRL), &hi, &lo);
|
|
hi &= 0x000000f8;
|
|
conf_data = CFG_PCI_CACHE_LINE_SIZE(PCI_NORMAL_HEADER_TYPE, hi);
|
|
break;
|
|
case PCI_BAR4_REG:
|
|
_rdmsr(GLCP_MSR_REG(GLCP_SOFT_COM), &hi, &lo);
|
|
if (lo & SOFT_BAR_IDE_FLAG) {
|
|
conf_data = CS5536_IDE_RANGE |
|
|
PCI_BASE_ADDRESS_SPACE_IO;
|
|
lo &= ~SOFT_BAR_IDE_FLAG;
|
|
_wrmsr(GLCP_MSR_REG(GLCP_SOFT_COM), hi, lo);
|
|
} else {
|
|
_rdmsr(IDE_MSR_REG(IDE_IO_BAR), &hi, &lo);
|
|
conf_data = lo & 0xfffffff0;
|
|
conf_data |= 0x01;
|
|
conf_data &= ~0x02;
|
|
}
|
|
break;
|
|
case PCI_CARDBUS_CIS:
|
|
conf_data = PCI_CARDBUS_CIS_POINTER;
|
|
break;
|
|
case PCI_SUBSYSTEM_VENDOR_ID:
|
|
conf_data =
|
|
CFG_PCI_VENDOR_ID(CS5536_IDE_SUB_ID, CS5536_SUB_VENDOR_ID);
|
|
break;
|
|
case PCI_ROM_ADDRESS:
|
|
conf_data = PCI_EXPANSION_ROM_BAR;
|
|
break;
|
|
case PCI_CAPABILITY_LIST:
|
|
conf_data = PCI_CAPLIST_POINTER;
|
|
break;
|
|
case PCI_INTERRUPT_LINE:
|
|
conf_data =
|
|
CFG_PCI_INTERRUPT_LINE(PCI_DEFAULT_PIN, CS5536_IDE_INTR);
|
|
break;
|
|
case PCI_IDE_CFG_REG:
|
|
_rdmsr(IDE_MSR_REG(IDE_CFG), &hi, &lo);
|
|
conf_data = lo;
|
|
break;
|
|
case PCI_IDE_DTC_REG:
|
|
_rdmsr(IDE_MSR_REG(IDE_DTC), &hi, &lo);
|
|
conf_data = lo;
|
|
break;
|
|
case PCI_IDE_CAST_REG:
|
|
_rdmsr(IDE_MSR_REG(IDE_CAST), &hi, &lo);
|
|
conf_data = lo;
|
|
break;
|
|
case PCI_IDE_ETC_REG:
|
|
_rdmsr(IDE_MSR_REG(IDE_ETC), &hi, &lo);
|
|
conf_data = lo;
|
|
break;
|
|
case PCI_IDE_PM_REG:
|
|
_rdmsr(IDE_MSR_REG(IDE_INTERNAL_PM), &hi, &lo);
|
|
conf_data = lo;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return conf_data;
|
|
}
|