pch_phub.c revision cf4ece53460c64a04a643ef13f6b6cb4bf3a8342
1cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/*
2cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * Copyright (C) 2010 OKI SEMICONDUCTOR Co., LTD.
3cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak *
4cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * This program is free software; you can redistribute it and/or modify
5cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * it under the terms of the GNU General Public License as published by
6cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * the Free Software Foundation; version 2 of the License.
7cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak *
8cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * This program is distributed in the hope that it will be useful,
9cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * but WITHOUT ANY WARRANTY; without even the implied warranty of
10cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
11cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * GNU General Public License for more details.
12cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak *
13cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * You should have received a copy of the GNU General Public License
14cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * along with this program; if not, write to the Free Software
15cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307, USA.
16cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak */
17cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
18cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#include <linux/module.h>
19cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#include <linux/kernel.h>
20cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#include <linux/types.h>
21cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#include <linux/fs.h>
22cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#include <linux/uaccess.h>
23cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#include <linux/string.h>
24cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#include <linux/pci.h>
25cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#include <linux/io.h>
26cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#include <linux/delay.h>
27cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#include <linux/mutex.h>
28cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#include <linux/if_ether.h>
29cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#include <linux/ctype.h>
30cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
31cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PHUB_STATUS 0x00		/* Status Register offset */
32cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PHUB_CONTROL 0x04		/* Control Register offset */
33cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PHUB_TIMEOUT 0x05		/* Time out value for Status Register */
34cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_ROM_WRITE_ENABLE 0x01	/* Enabling for writing ROM */
35cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_ROM_WRITE_DISABLE 0x00	/* Disabling for writing ROM */
36cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_ROM_START_ADDR 0x14	/* ROM data area start address offset */
37cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
38cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/* MAX number of INT_REDUCE_CONTROL registers */
39cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define MAX_NUM_INT_REDUCE_CONTROL_REG 128
40cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCI_DEVICE_ID_PCH1_PHUB 0x8801
41cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_MINOR_NOS 1
42cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define CLKCFG_CAN_50MHZ 0x12000000
43cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define CLKCFG_CANCLK_MASK 0xFF000000
44cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
45cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/* SROM ACCESS Macro */
46cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_WORD_ADDR_MASK (~((1 << 2) - 1))
47cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
48cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/* Registers address offset */
49cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_ID_REG				0x0000
50cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_QUEUE_PRI_VAL_REG		0x0004
51cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_RC_QUEUE_MAXSIZE_REG		0x0008
52cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_BRI_QUEUE_MAXSIZE_REG		0x000C
53cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_COMP_RESP_TIMEOUT_REG		0x0010
54cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_BUS_SLAVE_CONTROL_REG		0x0014
55cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_DEADLOCK_AVOID_TYPE_REG	0x0018
56cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_INTPIN_REG_WPERMIT_REG0	0x0020
57cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_INTPIN_REG_WPERMIT_REG1	0x0024
58cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_INTPIN_REG_WPERMIT_REG2	0x0028
59cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_INTPIN_REG_WPERMIT_REG3	0x002C
60cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_INT_REDUCE_CONTROL_REG_BASE	0x0040
61cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define CLKCFG_REG_OFFSET			0x500
62cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
63cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define PCH_PHUB_OROM_SIZE 15360
64cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
65cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/**
66cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * struct pch_phub_reg - PHUB register structure
67cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @phub_id_reg:			PHUB_ID register val
68cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @q_pri_val_reg:			QUEUE_PRI_VAL register val
69cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @rc_q_maxsize_reg:			RC_QUEUE_MAXSIZE register val
70cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @bri_q_maxsize_reg:			BRI_QUEUE_MAXSIZE register val
71cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @comp_resp_timeout_reg:		COMP_RESP_TIMEOUT register val
72cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @bus_slave_control_reg:		BUS_SLAVE_CONTROL_REG register val
73cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @deadlock_avoid_type_reg:		DEADLOCK_AVOID_TYPE register val
74cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @intpin_reg_wpermit_reg0:		INTPIN_REG_WPERMIT register 0 val
75cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @intpin_reg_wpermit_reg1:		INTPIN_REG_WPERMIT register 1 val
76cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @intpin_reg_wpermit_reg2:		INTPIN_REG_WPERMIT register 2 val
77cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @intpin_reg_wpermit_reg3:		INTPIN_REG_WPERMIT register 3 val
78cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @int_reduce_control_reg:		INT_REDUCE_CONTROL registers val
79cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @clkcfg_reg:				CLK CFG register val
80cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @pch_phub_base_address:		Register base address
81cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @pch_phub_extrom_base_address:	external rom base address
82cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak */
83cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstruct pch_phub_reg {
84cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u32 phub_id_reg;
85cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u32 q_pri_val_reg;
86cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u32 rc_q_maxsize_reg;
87cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u32 bri_q_maxsize_reg;
88cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u32 comp_resp_timeout_reg;
89cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u32 bus_slave_control_reg;
90cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u32 deadlock_avoid_type_reg;
91cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u32 intpin_reg_wpermit_reg0;
92cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u32 intpin_reg_wpermit_reg1;
93cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u32 intpin_reg_wpermit_reg2;
94cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u32 intpin_reg_wpermit_reg3;
95cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u32 int_reduce_control_reg[MAX_NUM_INT_REDUCE_CONTROL_REG];
96cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u32 clkcfg_reg;
97cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	void __iomem *pch_phub_base_address;
98cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	void __iomem *pch_phub_extrom_base_address;
99cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak};
100cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
101cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/* SROM SPEC for MAC address assignment offset */
102cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic const int pch_phub_mac_offset[ETH_ALEN] = {0x3, 0x2, 0x1, 0x0, 0xb, 0xa};
103cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
104cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic DEFINE_MUTEX(pch_phub_mutex);
105cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
106cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/**
107cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * pch_phub_read_modify_write_reg() - Reading modifying and writing register
108cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @reg_addr_offset:	Register offset address value.
109cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @data:		Writing value.
110cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @mask:		Mask value.
111cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak */
112cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic void pch_phub_read_modify_write_reg(struct pch_phub_reg *chip,
113cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak					   unsigned int reg_addr_offset,
114cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak					   unsigned int data, unsigned int mask)
115cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
116cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	void __iomem *reg_addr = chip->pch_phub_base_address + reg_addr_offset;
117cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(((ioread32(reg_addr) & ~mask)) | data, reg_addr);
118cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
119cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
120cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/* pch_phub_save_reg_conf - saves register configuration */
121cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic void pch_phub_save_reg_conf(struct pci_dev *pdev)
122cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
123cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned int i;
124cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	struct pch_phub_reg *chip = pci_get_drvdata(pdev);
125cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
126cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	void __iomem *p = chip->pch_phub_base_address;
127cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
128cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->phub_id_reg = ioread32(p + PCH_PHUB_ID_REG);
129cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->q_pri_val_reg = ioread32(p + PCH_PHUB_QUEUE_PRI_VAL_REG);
130cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->rc_q_maxsize_reg = ioread32(p + PCH_PHUB_RC_QUEUE_MAXSIZE_REG);
131cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->bri_q_maxsize_reg = ioread32(p + PCH_PHUB_BRI_QUEUE_MAXSIZE_REG);
132cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->comp_resp_timeout_reg =
133cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				ioread32(p + PCH_PHUB_COMP_RESP_TIMEOUT_REG);
134cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->bus_slave_control_reg =
135cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				ioread32(p + PCH_PHUB_BUS_SLAVE_CONTROL_REG);
136cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->deadlock_avoid_type_reg =
137cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				ioread32(p + PCH_PHUB_DEADLOCK_AVOID_TYPE_REG);
138cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->intpin_reg_wpermit_reg0 =
139cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				ioread32(p + PCH_PHUB_INTPIN_REG_WPERMIT_REG0);
140cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->intpin_reg_wpermit_reg1 =
141cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				ioread32(p + PCH_PHUB_INTPIN_REG_WPERMIT_REG1);
142cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->intpin_reg_wpermit_reg2 =
143cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				ioread32(p + PCH_PHUB_INTPIN_REG_WPERMIT_REG2);
144cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->intpin_reg_wpermit_reg3 =
145cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				ioread32(p + PCH_PHUB_INTPIN_REG_WPERMIT_REG3);
146cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	dev_dbg(&pdev->dev, "%s : "
147cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->phub_id_reg=%x, "
148cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->q_pri_val_reg=%x, "
149cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->rc_q_maxsize_reg=%x, "
150cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->bri_q_maxsize_reg=%x, "
151cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->comp_resp_timeout_reg=%x, "
152cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->bus_slave_control_reg=%x, "
153cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->deadlock_avoid_type_reg=%x, "
154cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->intpin_reg_wpermit_reg0=%x, "
155cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->intpin_reg_wpermit_reg1=%x, "
156cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->intpin_reg_wpermit_reg2=%x, "
157cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->intpin_reg_wpermit_reg3=%x\n", __func__,
158cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->phub_id_reg,
159cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->q_pri_val_reg,
160cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->rc_q_maxsize_reg,
161cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->bri_q_maxsize_reg,
162cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->comp_resp_timeout_reg,
163cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->bus_slave_control_reg,
164cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->deadlock_avoid_type_reg,
165cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->intpin_reg_wpermit_reg0,
166cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->intpin_reg_wpermit_reg1,
167cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->intpin_reg_wpermit_reg2,
168cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->intpin_reg_wpermit_reg3);
169cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	for (i = 0; i < MAX_NUM_INT_REDUCE_CONTROL_REG; i++) {
170cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->int_reduce_control_reg[i] =
171cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		    ioread32(p + PCH_PHUB_INT_REDUCE_CONTROL_REG_BASE + 4 * i);
172cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		dev_dbg(&pdev->dev, "%s : "
173cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			"chip->int_reduce_control_reg[%d]=%x\n",
174cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			__func__, i, chip->int_reduce_control_reg[i]);
175cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
176cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->clkcfg_reg = ioread32(p + CLKCFG_REG_OFFSET);
177cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
178cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
179cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/* pch_phub_restore_reg_conf - restore register configuration */
180cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic void pch_phub_restore_reg_conf(struct pci_dev *pdev)
181cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
182cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned int i;
183cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	struct pch_phub_reg *chip = pci_get_drvdata(pdev);
184cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	void __iomem *p;
185cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	p = chip->pch_phub_base_address;
186cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
187cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(chip->phub_id_reg, p + PCH_PHUB_ID_REG);
188cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(chip->q_pri_val_reg, p + PCH_PHUB_QUEUE_PRI_VAL_REG);
189cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(chip->rc_q_maxsize_reg, p + PCH_PHUB_RC_QUEUE_MAXSIZE_REG);
190cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(chip->bri_q_maxsize_reg, p + PCH_PHUB_BRI_QUEUE_MAXSIZE_REG);
191cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(chip->comp_resp_timeout_reg,
192cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak					p + PCH_PHUB_COMP_RESP_TIMEOUT_REG);
193cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(chip->bus_slave_control_reg,
194cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak					p + PCH_PHUB_BUS_SLAVE_CONTROL_REG);
195cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(chip->deadlock_avoid_type_reg,
196cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak					p + PCH_PHUB_DEADLOCK_AVOID_TYPE_REG);
197cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(chip->intpin_reg_wpermit_reg0,
198cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak					p + PCH_PHUB_INTPIN_REG_WPERMIT_REG0);
199cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(chip->intpin_reg_wpermit_reg1,
200cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak					p + PCH_PHUB_INTPIN_REG_WPERMIT_REG1);
201cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(chip->intpin_reg_wpermit_reg2,
202cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak					p + PCH_PHUB_INTPIN_REG_WPERMIT_REG2);
203cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(chip->intpin_reg_wpermit_reg3,
204cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak					p + PCH_PHUB_INTPIN_REG_WPERMIT_REG3);
205cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	dev_dbg(&pdev->dev, "%s : "
206cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->phub_id_reg=%x, "
207cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->q_pri_val_reg=%x, "
208cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->rc_q_maxsize_reg=%x, "
209cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->bri_q_maxsize_reg=%x, "
210cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->comp_resp_timeout_reg=%x, "
211cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->bus_slave_control_reg=%x, "
212cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->deadlock_avoid_type_reg=%x, "
213cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->intpin_reg_wpermit_reg0=%x, "
214cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->intpin_reg_wpermit_reg1=%x, "
215cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->intpin_reg_wpermit_reg2=%x, "
216cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"chip->intpin_reg_wpermit_reg3=%x\n", __func__,
217cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->phub_id_reg,
218cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->q_pri_val_reg,
219cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->rc_q_maxsize_reg,
220cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->bri_q_maxsize_reg,
221cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->comp_resp_timeout_reg,
222cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->bus_slave_control_reg,
223cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->deadlock_avoid_type_reg,
224cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->intpin_reg_wpermit_reg0,
225cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->intpin_reg_wpermit_reg1,
226cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->intpin_reg_wpermit_reg2,
227cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		chip->intpin_reg_wpermit_reg3);
228cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	for (i = 0; i < MAX_NUM_INT_REDUCE_CONTROL_REG; i++) {
229cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		iowrite32(chip->int_reduce_control_reg[i],
230cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			p + PCH_PHUB_INT_REDUCE_CONTROL_REG_BASE + 4 * i);
231cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		dev_dbg(&pdev->dev, "%s : "
232cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			"chip->int_reduce_control_reg[%d]=%x\n",
233cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			__func__, i, chip->int_reduce_control_reg[i]);
234cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
235cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
236cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(chip->clkcfg_reg, p + CLKCFG_REG_OFFSET);
237cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
238cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
239cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/**
240cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * pch_phub_read_serial_rom() - Reading Serial ROM
241cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @offset_address:	Serial ROM offset address to read.
242cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @data:		Read buffer for specified Serial ROM value.
243cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak */
244cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic void pch_phub_read_serial_rom(struct pch_phub_reg *chip,
245cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				     unsigned int offset_address, u8 *data)
246cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
247cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	void __iomem *mem_addr = chip->pch_phub_extrom_base_address +
248cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak								offset_address;
249cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
250cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	*data = ioread8(mem_addr);
251cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
252cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
253cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/**
254cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * pch_phub_write_serial_rom() - Writing Serial ROM
255cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @offset_address:	Serial ROM offset address.
256cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @data:		Serial ROM value to write.
257cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak */
258cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic int pch_phub_write_serial_rom(struct pch_phub_reg *chip,
259cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				     unsigned int offset_address, u8 data)
260cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
261cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	void __iomem *mem_addr = chip->pch_phub_extrom_base_address +
262cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak					(offset_address & PCH_WORD_ADDR_MASK);
263cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int i;
264cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned int word_data;
265cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned int pos;
266cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned int mask;
267cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pos = (offset_address % 4) * 8;
268cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	mask = ~(0xFF << pos);
269cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
270cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(PCH_PHUB_ROM_WRITE_ENABLE,
271cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			chip->pch_phub_extrom_base_address + PHUB_CONTROL);
272cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
273cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	word_data = ioread32(mem_addr);
274cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32((word_data & mask) | (u32)data << pos, mem_addr);
275cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
276cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	i = 0;
277cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	while (ioread8(chip->pch_phub_extrom_base_address +
278cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak						PHUB_STATUS) != 0x00) {
279cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		msleep(1);
280cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		if (i == PHUB_TIMEOUT)
281cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			return -ETIMEDOUT;
282cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		i++;
283cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
284cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
285cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(PCH_PHUB_ROM_WRITE_DISABLE,
286cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			chip->pch_phub_extrom_base_address + PHUB_CONTROL);
287cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
288cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return 0;
289cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
290cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
291cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/**
292cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * pch_phub_read_serial_rom_val() - Read Serial ROM value
293cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @offset_address:	Serial ROM address offset value.
294cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @data:		Serial ROM value to read.
295cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak */
296cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic void pch_phub_read_serial_rom_val(struct pch_phub_reg *chip,
297cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak					 unsigned int offset_address, u8 *data)
298cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
299cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned int mem_addr;
300cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
301cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	mem_addr = PCH_PHUB_ROM_START_ADDR +
302cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			pch_phub_mac_offset[offset_address];
303cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
304cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pch_phub_read_serial_rom(chip, mem_addr, data);
305cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
306cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
307cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/**
308cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * pch_phub_write_serial_rom_val() - writing Serial ROM value
309cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @offset_address:	Serial ROM address offset value.
310cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @data:		Serial ROM value.
311cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak */
312cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic int pch_phub_write_serial_rom_val(struct pch_phub_reg *chip,
313cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak					 unsigned int offset_address, u8 data)
314cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
315cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int retval;
316cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned int mem_addr;
317cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
318cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	mem_addr = PCH_PHUB_ROM_START_ADDR +
319cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			pch_phub_mac_offset[offset_address];
320cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
321cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval = pch_phub_write_serial_rom(chip, mem_addr, data);
322cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
323cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return retval;
324cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
325cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
326cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/* pch_phub_gbe_serial_rom_conf - makes Serial ROM header format configuration
327cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * for Gigabit Ethernet MAC address
328cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak */
329cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic int pch_phub_gbe_serial_rom_conf(struct pch_phub_reg *chip)
330cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
331cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int retval;
332cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
333cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval = pch_phub_write_serial_rom(chip, 0x0b, 0xbc);
334cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x0a, 0x10);
335cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x09, 0x01);
336cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x08, 0x02);
337cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
338cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x0f, 0x00);
339cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x0e, 0x00);
340cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x0d, 0x00);
341cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x0c, 0x80);
342cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
343cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x13, 0xbc);
344cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x12, 0x10);
345cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x11, 0x01);
346cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x10, 0x18);
347cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
348cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x1b, 0xbc);
349cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x1a, 0x10);
350cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x19, 0x01);
351cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x18, 0x19);
352cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
353cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x23, 0xbc);
354cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x22, 0x10);
355cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x21, 0x01);
356cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x20, 0x3a);
357cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
358cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x27, 0x01);
359cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x26, 0x00);
360cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x25, 0x00);
361cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval |= pch_phub_write_serial_rom(chip, 0x24, 0x00);
362cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
363cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return retval;
364cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
365cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
366cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/**
367cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * pch_phub_read_gbe_mac_addr() - Read Gigabit Ethernet MAC address
368cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @offset_address:	Gigabit Ethernet MAC address offset value.
369cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @data:		Buffer of the Gigabit Ethernet MAC address value.
370cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak */
371cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic void pch_phub_read_gbe_mac_addr(struct pch_phub_reg *chip, u8 *data)
372cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
373cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int i;
374cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	for (i = 0; i < ETH_ALEN; i++)
375cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		pch_phub_read_serial_rom_val(chip, i, &data[i]);
376cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
377cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
378cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak/**
379cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * pch_phub_write_gbe_mac_addr() - Write MAC address
380cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @offset_address:	Gigabit Ethernet MAC address offset value.
381cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak * @data:		Gigabit Ethernet MAC address value.
382cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak */
383cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic int pch_phub_write_gbe_mac_addr(struct pch_phub_reg *chip, u8 *data)
384cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
385cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int retval;
386cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int i;
387cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
388cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval = pch_phub_gbe_serial_rom_conf(chip);
389cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (retval)
390cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		return retval;
391cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
392cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	for (i = 0; i < ETH_ALEN; i++) {
393cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		retval = pch_phub_write_serial_rom_val(chip, i, data[i]);
394cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		if (retval)
395cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			return retval;
396cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
397cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
398cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return retval;
399cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
400cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
401cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic ssize_t pch_phub_bin_read(struct file *filp, struct kobject *kobj,
402cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				 struct bin_attribute *attr, char *buf,
403cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				 loff_t off, size_t count)
404cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
405cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned int rom_signature;
406cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned char rom_length;
407cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned int tmp;
408cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned int addr_offset;
409cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned int orom_size;
410cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int ret;
411cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int err;
412cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
413cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	struct pch_phub_reg *chip =
414cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		dev_get_drvdata(container_of(kobj, struct device, kobj));
415cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
416cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	ret = mutex_lock_interruptible(&pch_phub_mutex);
417cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (ret) {
418cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		err = -ERESTARTSYS;
419cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		goto return_err_nomutex;
420cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
421cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
422cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	/* Get Rom signature */
423cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pch_phub_read_serial_rom(chip, 0x80, (unsigned char *)&rom_signature);
424cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	rom_signature &= 0xff;
425cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pch_phub_read_serial_rom(chip, 0x81, (unsigned char *)&tmp);
426cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	rom_signature |= (tmp & 0xff) << 8;
427cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (rom_signature == 0xAA55) {
428cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		pch_phub_read_serial_rom(chip, 0x82, &rom_length);
429cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		orom_size = rom_length * 512;
430cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		if (orom_size < off) {
431cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			addr_offset = 0;
432cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			goto return_ok;
433cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		}
434cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		if (orom_size < count) {
435cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			addr_offset = 0;
436cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			goto return_ok;
437cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		}
438cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
439cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		for (addr_offset = 0; addr_offset < count; addr_offset++) {
440cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			pch_phub_read_serial_rom(chip, 0x80 + addr_offset + off,
441cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak							 &buf[addr_offset]);
442cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		}
443cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	} else {
444cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		err = -ENODATA;
445cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		goto return_err;
446cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
447cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakreturn_ok:
448cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	mutex_unlock(&pch_phub_mutex);
449cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return addr_offset;
450cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
451cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakreturn_err:
452cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	mutex_unlock(&pch_phub_mutex);
453cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakreturn_err_nomutex:
454cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return err;
455cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
456cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
457cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic ssize_t pch_phub_bin_write(struct file *filp, struct kobject *kobj,
458cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				  struct bin_attribute *attr,
459cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				  char *buf, loff_t off, size_t count)
460cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
461cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int err;
462cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned int addr_offset;
463cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int ret;
464cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	struct pch_phub_reg *chip =
465cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		dev_get_drvdata(container_of(kobj, struct device, kobj));
466cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
467cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	ret = mutex_lock_interruptible(&pch_phub_mutex);
468cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (ret)
469cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		return -ERESTARTSYS;
470cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
471cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (off > PCH_PHUB_OROM_SIZE) {
472cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		addr_offset = 0;
473cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		goto return_ok;
474cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
475cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (count > PCH_PHUB_OROM_SIZE) {
476cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		addr_offset = 0;
477cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		goto return_ok;
478cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
479cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
480cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	for (addr_offset = 0; addr_offset < count; addr_offset++) {
481cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		if (PCH_PHUB_OROM_SIZE < off + addr_offset)
482cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			goto return_ok;
483cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
484cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		ret = pch_phub_write_serial_rom(chip, 0x80 + addr_offset + off,
485cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak						       buf[addr_offset]);
486cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		if (ret) {
487cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			err = ret;
488cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			goto return_err;
489cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		}
490cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
491cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
492cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakreturn_ok:
493cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	mutex_unlock(&pch_phub_mutex);
494cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return addr_offset;
495cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
496cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakreturn_err:
497cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	mutex_unlock(&pch_phub_mutex);
498cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return err;
499cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
500cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
501cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic ssize_t show_pch_mac(struct device *dev, struct device_attribute *attr,
502cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			    char *buf)
503cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
504cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u8 mac[8];
505cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	struct pch_phub_reg *chip = dev_get_drvdata(dev);
506cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
507cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pch_phub_read_gbe_mac_addr(chip, mac);
508cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
509cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return sprintf(buf, "%02x:%02x:%02x:%02x:%02x:%02x\n",
510cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
511cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
512cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
513cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic ssize_t store_pch_mac(struct device *dev, struct device_attribute *attr,
514cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			     const char *buf, size_t count)
515cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
516cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	u8 mac[6];
517cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	struct pch_phub_reg *chip = dev_get_drvdata(dev);
518cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
519cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (count != 18)
520cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		return -EINVAL;
521cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
522cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	sscanf(buf, "%02x:%02x:%02x:%02x:%02x:%02x",
523cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		(u32 *)&mac[0], (u32 *)&mac[1], (u32 *)&mac[2], (u32 *)&mac[3],
524cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		(u32 *)&mac[4], (u32 *)&mac[5]);
525cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
526cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pch_phub_write_gbe_mac_addr(chip, mac);
527cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
528cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return count;
529cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
530cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
531cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic DEVICE_ATTR(pch_mac, S_IRUGO | S_IWUSR, show_pch_mac, store_pch_mac);
532cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
533cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic struct bin_attribute pch_bin_attr = {
534cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	.attr = {
535cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		.name = "pch_firmware",
536cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		.mode = S_IRUGO | S_IWUSR,
537cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	},
538cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	.size = PCH_PHUB_OROM_SIZE + 1,
539cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	.read = pch_phub_bin_read,
540cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	.write = pch_phub_bin_write,
541cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak};
542cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
543cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic int __devinit pch_phub_probe(struct pci_dev *pdev,
544cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak				    const struct pci_device_id *id)
545cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
546cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int retval;
547cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
548cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int ret;
549cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	unsigned int rom_size;
550cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	struct pch_phub_reg *chip;
551cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
552cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip = kzalloc(sizeof(struct pch_phub_reg), GFP_KERNEL);
553cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (chip == NULL)
554cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		return -ENOMEM;
555cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
556cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	ret = pci_enable_device(pdev);
557cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (ret) {
558cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		dev_err(&pdev->dev,
559cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"%s : pci_enable_device FAILED(ret=%d)", __func__, ret);
560cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		goto err_pci_enable_dev;
561cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
562cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	dev_dbg(&pdev->dev, "%s : pci_enable_device returns %d\n", __func__,
563cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		ret);
564cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
565cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	ret = pci_request_regions(pdev, KBUILD_MODNAME);
566cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (ret) {
567cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		dev_err(&pdev->dev,
568cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"%s : pci_request_regions FAILED(ret=%d)", __func__, ret);
569cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		goto err_req_regions;
570cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
571cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	dev_dbg(&pdev->dev, "%s : "
572cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"pci_request_regions returns %d\n", __func__, ret);
573cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
574cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->pch_phub_base_address = pci_iomap(pdev, 1, 0);
575cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
576cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
577cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (chip->pch_phub_base_address == 0) {
578cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		dev_err(&pdev->dev, "%s : pci_iomap FAILED", __func__);
579cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		ret = -ENOMEM;
580cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		goto err_pci_iomap;
581cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
582cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	dev_dbg(&pdev->dev, "%s : pci_iomap SUCCESS and value "
583cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"in pch_phub_base_address variable is 0x%08x\n", __func__,
584cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		(unsigned int)chip->pch_phub_base_address);
585cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	chip->pch_phub_extrom_base_address = pci_map_rom(pdev, &rom_size);
586cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
587cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (chip->pch_phub_extrom_base_address == 0) {
588cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		dev_err(&pdev->dev, "%s : pci_map_rom FAILED", __func__);
589cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		ret = -ENOMEM;
590cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		goto err_pci_map;
591cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
592cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	dev_dbg(&pdev->dev, "%s : "
593cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"pci_map_rom SUCCESS and value in "
594cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"pch_phub_extrom_base_address variable is 0x%08x\n", __func__,
595cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		(unsigned int)chip->pch_phub_extrom_base_address);
596cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
597cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_set_drvdata(pdev, chip);
598cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
599cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval = sysfs_create_file(&pdev->dev.kobj, &dev_attr_pch_mac.attr);
600cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (retval)
601cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		goto err_sysfs_create;
602cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
603cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	retval = sysfs_create_bin_file(&pdev->dev.kobj, &pch_bin_attr);
604cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (retval)
605cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		goto exit_bin_attr;
606cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
607cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pch_phub_read_modify_write_reg(chip, (unsigned int)CLKCFG_REG_OFFSET,
608cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak					CLKCFG_CAN_50MHZ, CLKCFG_CANCLK_MASK);
609cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
610cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	/* set the prefech value */
611cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(0x000affaa, chip->pch_phub_base_address + 0x14);
612cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	/* set the interrupt delay value */
613cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	iowrite32(0x25, chip->pch_phub_base_address + 0x44);
614cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
615cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return 0;
616cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakexit_bin_attr:
617cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	sysfs_remove_file(&pdev->dev.kobj, &dev_attr_pch_mac.attr);
618cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
619cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakerr_sysfs_create:
620cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_unmap_rom(pdev, chip->pch_phub_extrom_base_address);
621cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakerr_pci_map:
622cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_iounmap(pdev, chip->pch_phub_base_address);
623cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakerr_pci_iomap:
624cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_release_regions(pdev);
625cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakerr_req_regions:
626cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_disable_device(pdev);
627cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakerr_pci_enable_dev:
628cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	kfree(chip);
629cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	dev_err(&pdev->dev, "%s returns %d\n", __func__, ret);
630cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return ret;
631cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
632cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
633cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic void __devexit pch_phub_remove(struct pci_dev *pdev)
634cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
635cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	struct pch_phub_reg *chip = pci_get_drvdata(pdev);
636cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
637cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	sysfs_remove_file(&pdev->dev.kobj, &dev_attr_pch_mac.attr);
638cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	sysfs_remove_bin_file(&pdev->dev.kobj, &pch_bin_attr);
639cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_unmap_rom(pdev, chip->pch_phub_extrom_base_address);
640cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_iounmap(pdev, chip->pch_phub_base_address);
641cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_release_regions(pdev);
642cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_disable_device(pdev);
643cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	kfree(chip);
644cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
645cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
646cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#ifdef CONFIG_PM
647cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
648cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic int pch_phub_suspend(struct pci_dev *pdev, pm_message_t state)
649cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
650cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int ret;
651cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
652cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pch_phub_save_reg_conf(pdev);
653cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	ret = pci_save_state(pdev);
654cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (ret) {
655cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		dev_err(&pdev->dev,
656cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak			" %s -pci_save_state returns %d\n", __func__, ret);
657cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		return ret;
658cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
659cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_enable_wake(pdev, PCI_D3hot, 0);
660cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_disable_device(pdev);
661cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_set_power_state(pdev, pci_choose_state(pdev, state));
662cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
663cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return 0;
664cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
665cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
666cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic int pch_phub_resume(struct pci_dev *pdev)
667cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
668cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	int ret;
669cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
670cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_set_power_state(pdev, PCI_D0);
671cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_restore_state(pdev);
672cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	ret = pci_enable_device(pdev);
673cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	if (ret) {
674cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		dev_err(&pdev->dev,
675cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		"%s-pci_enable_device failed(ret=%d) ", __func__, ret);
676cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak		return ret;
677cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	}
678cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
679cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_enable_wake(pdev, PCI_D3hot, 0);
680cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pch_phub_restore_reg_conf(pdev);
681cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
682cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return 0;
683cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
684cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#else
685cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define pch_phub_suspend NULL
686cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#define pch_phub_resume NULL
687cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak#endif /* CONFIG_PM */
688cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
689cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic struct pci_device_id pch_phub_pcidev_id[] = {
690cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	{PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PCH1_PHUB)},
691cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	{0,}
692cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak};
693cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
694cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic struct pci_driver pch_phub_driver = {
695cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	.name = "pch_phub",
696cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	.id_table = pch_phub_pcidev_id,
697cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	.probe = pch_phub_probe,
698cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	.remove = __devexit_p(pch_phub_remove),
699cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	.suspend = pch_phub_suspend,
700cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	.resume = pch_phub_resume
701cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak};
702cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
703cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic int __init pch_phub_pci_init(void)
704cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
705cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	return pci_register_driver(&pch_phub_driver);
706cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
707cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
708cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakstatic void __exit pch_phub_pci_exit(void)
709cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak{
710cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak	pci_unregister_driver(&pch_phub_driver);
711cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak}
712cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
713cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakmodule_init(pch_phub_pci_init);
714cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtakmodule_exit(pch_phub_pci_exit);
715cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki Ohtak
716cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki OhtakMODULE_DESCRIPTION("PCH Packet Hub PCI Driver");
717cf4ece53460c64a04a643ef13f6b6cb4bf3a8342Masayuki OhtakMODULE_LICENSE("GPL");
718