sh_eth.c revision a8e9fd0f7462f5cada5189513d12fe6c9cce2105
186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/*
286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *  SuperH Ethernet device driver
386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *
4f0e81fecd4f83de7854262c8a6b3af19dfa99bf9Nobuhiro Iwamatsu *  Copyright (C) 2006-2012 Nobuhiro Iwamatsu
5a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov *  Copyright (C) 2008-2013 Renesas Solutions Corp.
6a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov *  Copyright (C) 2013 Cogent Embedded, Inc.
786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *
886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *  This program is free software; you can redistribute it and/or modify it
986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *  under the terms and conditions of the GNU General Public License,
1086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *  version 2, as published by the Free Software Foundation.
1186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *
1286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *  This program is distributed in the hope it will be useful, but WITHOUT
1386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
1486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
1586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *  more details.
1686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *  You should have received a copy of the GNU General Public License along with
1786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *  this program; if not, write to the Free Software Foundation, Inc.,
1886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *  51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
1986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *
2086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *  The full GNU General Public License is included in this distribution in
2186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *  the file called "COPYING".
2286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu */
2386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
2486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu#include <linux/init.h>
250654011d900670884197d9a06ad17b378dfde831Yoshihiro Shimoda#include <linux/module.h>
260654011d900670884197d9a06ad17b378dfde831Yoshihiro Shimoda#include <linux/kernel.h>
270654011d900670884197d9a06ad17b378dfde831Yoshihiro Shimoda#include <linux/spinlock.h>
286a27cdeddf48858089e3672f844615cbf0877ebfNobuhiro Iwamatsu#include <linux/interrupt.h>
2986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu#include <linux/dma-mapping.h>
3086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu#include <linux/etherdevice.h>
3186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu#include <linux/delay.h>
3286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu#include <linux/platform_device.h>
3386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu#include <linux/mdio-bitbang.h>
3486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu#include <linux/netdevice.h>
3586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu#include <linux/phy.h>
3686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu#include <linux/cache.h>
3786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu#include <linux/io.h>
38bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm#include <linux/pm_runtime.h>
395a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h>
40dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu#include <linux/ethtool.h>
41fdb37a7f84a58ccad24abffd54ad46d23b763e13Yoshihiro Shimoda#include <linux/if_vlan.h>
42f0e81fecd4f83de7854262c8a6b3af19dfa99bf9Nobuhiro Iwamatsu#include <linux/clk.h>
43d4fa0e35fdbd54acf791fa3793d6d17f7795f7aeYoshihiro Shimoda#include <linux/sh_eth.h>
4486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
4586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu#include "sh_eth.h"
4686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
47dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu#define SH_ETH_DEF_MSG_ENABLE \
48dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		(NETIF_MSG_LINK	| \
49dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		NETIF_MSG_TIMER	| \
50dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		NETIF_MSG_RX_ERR| \
51dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		NETIF_MSG_TX_ERR)
52dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
53c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyovstatic const u16 sh_eth_offset_gigabit[SH_ETH_MAX_REGISTER_OFFSET] = {
54c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[EDSR]		= 0x0000,
55c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[EDMR]		= 0x0400,
56c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[EDTRR]		= 0x0408,
57c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[EDRRR]		= 0x0410,
58c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[EESR]		= 0x0428,
59c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[EESIPR]	= 0x0430,
60c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TDLAR]		= 0x0010,
61c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TDFAR]		= 0x0014,
62c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TDFXR]		= 0x0018,
63c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TDFFR]		= 0x001c,
64c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RDLAR]		= 0x0030,
65c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RDFAR]		= 0x0034,
66c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RDFXR]		= 0x0038,
67c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RDFFR]		= 0x003c,
68c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TRSCER]	= 0x0438,
69c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RMFCR]		= 0x0440,
70c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TFTR]		= 0x0448,
71c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FDR]		= 0x0450,
72c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RMCR]		= 0x0458,
73c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RPADIR]	= 0x0460,
74c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FCFTR]		= 0x0468,
75c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[CSMR]		= 0x04E4,
76c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov
77c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[ECMR]		= 0x0500,
78c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[ECSR]		= 0x0510,
79c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[ECSIPR]	= 0x0518,
80c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[PIR]		= 0x0520,
81c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[PSR]		= 0x0528,
82c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[PIPR]		= 0x052c,
83c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RFLR]		= 0x0508,
84c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[APR]		= 0x0554,
85c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[MPR]		= 0x0558,
86c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[PFTCR]		= 0x055c,
87c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[PFRCR]		= 0x0560,
88c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TPAUSER]	= 0x0564,
89c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[GECMR]		= 0x05b0,
90c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[BCULR]		= 0x05b4,
91c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[MAHR]		= 0x05c0,
92c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[MALR]		= 0x05c8,
93c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TROCR]		= 0x0700,
94c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[CDCR]		= 0x0708,
95c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[LCCR]		= 0x0710,
96c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[CEFCR]		= 0x0740,
97c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FRECR]		= 0x0748,
98c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSFRCR]	= 0x0750,
99c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TLFRCR]	= 0x0758,
100c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RFCR]		= 0x0760,
101c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[CERCR]		= 0x0768,
102c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[CEECR]		= 0x0770,
103c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[MAFCR]		= 0x0778,
104c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RMII_MII]	= 0x0790,
105c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov
106c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[ARSTR]		= 0x0000,
107c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_CTRST]	= 0x0004,
108c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWEN0]	= 0x0010,
109c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWEN1]	= 0x0014,
110c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FCM]	= 0x0018,
111c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_BSYSL0]	= 0x0020,
112c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_BSYSL1]	= 0x0024,
113c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_PRISL0]	= 0x0028,
114c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_PRISL1]	= 0x002c,
115c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWSL0]	= 0x0030,
116c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWSL1]	= 0x0034,
117c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWSLC]	= 0x0038,
118c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_QTAG0]	= 0x0040,
119c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_QTAG1]	= 0x0044,
120c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWSR]	= 0x0050,
121c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWINMK]	= 0x0054,
122c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_ADQT0]	= 0x0048,
123c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_ADQT1]	= 0x004c,
124c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_VTAG0]	= 0x0058,
125c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_VTAG1]	= 0x005c,
126c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_ADSBSY]	= 0x0060,
127c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_TEN]	= 0x0064,
128c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_POST1]	= 0x0070,
129c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_POST2]	= 0x0074,
130c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_POST3]	= 0x0078,
131c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_POST4]	= 0x007c,
132c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_ADRH0]	= 0x0100,
133c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_ADRL0]	= 0x0104,
134c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_ADRH31]	= 0x01f8,
135c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_ADRL31]	= 0x01fc,
136c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov
137c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TXNLCR0]	= 0x0080,
138c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TXALCR0]	= 0x0084,
139c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RXNLCR0]	= 0x0088,
140c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RXALCR0]	= 0x008c,
141c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FWNLCR0]	= 0x0090,
142c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FWALCR0]	= 0x0094,
143c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TXNLCR1]	= 0x00a0,
144c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TXALCR1]	= 0x00a0,
145c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RXNLCR1]	= 0x00a8,
146c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RXALCR1]	= 0x00ac,
147c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FWNLCR1]	= 0x00b0,
148c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FWALCR1]	= 0x00b4,
149c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov};
150c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov
151a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyovstatic const u16 sh_eth_offset_fast_rcar[SH_ETH_MAX_REGISTER_OFFSET] = {
152a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[ECMR]		= 0x0300,
153a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[RFLR]		= 0x0308,
154a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[ECSR]		= 0x0310,
155a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[ECSIPR]	= 0x0318,
156a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[PIR]		= 0x0320,
157a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[PSR]		= 0x0328,
158a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[RDMLR]		= 0x0340,
159a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[IPGR]		= 0x0350,
160a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[APR]		= 0x0354,
161a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[MPR]		= 0x0358,
162a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[RFCF]		= 0x0360,
163a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[TPAUSER]	= 0x0364,
164a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[TPAUSECR]	= 0x0368,
165a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[MAHR]		= 0x03c0,
166a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[MALR]		= 0x03c8,
167a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[TROCR]		= 0x03d0,
168a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[CDCR]		= 0x03d4,
169a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[LCCR]		= 0x03d8,
170a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[CNDCR]		= 0x03dc,
171a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[CEFCR]		= 0x03e4,
172a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[FRECR]		= 0x03e8,
173a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[TSFRCR]	= 0x03ec,
174a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[TLFRCR]	= 0x03f0,
175a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[RFCR]		= 0x03f4,
176a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[MAFCR]		= 0x03f8,
177a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov
178a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[EDMR]		= 0x0200,
179a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[EDTRR]		= 0x0208,
180a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[EDRRR]		= 0x0210,
181a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[TDLAR]		= 0x0218,
182a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[RDLAR]		= 0x0220,
183a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[EESR]		= 0x0228,
184a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[EESIPR]	= 0x0230,
185a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[TRSCER]	= 0x0238,
186a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[RMFCR]		= 0x0240,
187a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[TFTR]		= 0x0248,
188a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[FDR]		= 0x0250,
189a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[RMCR]		= 0x0258,
190a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[TFUCR]		= 0x0264,
191a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[RFOCR]		= 0x0268,
192a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[FCFTR]		= 0x0270,
193a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	[TRIMD]		= 0x027c,
194a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov};
195a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov
196c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyovstatic const u16 sh_eth_offset_fast_sh4[SH_ETH_MAX_REGISTER_OFFSET] = {
197c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[ECMR]		= 0x0100,
198c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RFLR]		= 0x0108,
199c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[ECSR]		= 0x0110,
200c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[ECSIPR]	= 0x0118,
201c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[PIR]		= 0x0120,
202c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[PSR]		= 0x0128,
203c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RDMLR]		= 0x0140,
204c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[IPGR]		= 0x0150,
205c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[APR]		= 0x0154,
206c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[MPR]		= 0x0158,
207c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TPAUSER]	= 0x0164,
208c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RFCF]		= 0x0160,
209c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TPAUSECR]	= 0x0168,
210c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[BCFRR]		= 0x016c,
211c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[MAHR]		= 0x01c0,
212c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[MALR]		= 0x01c8,
213c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TROCR]		= 0x01d0,
214c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[CDCR]		= 0x01d4,
215c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[LCCR]		= 0x01d8,
216c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[CNDCR]		= 0x01dc,
217c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[CEFCR]		= 0x01e4,
218c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FRECR]		= 0x01e8,
219c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSFRCR]	= 0x01ec,
220c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TLFRCR]	= 0x01f0,
221c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RFCR]		= 0x01f4,
222c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[MAFCR]		= 0x01f8,
223c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RTRATE]	= 0x01fc,
224c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov
225c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[EDMR]		= 0x0000,
226c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[EDTRR]		= 0x0008,
227c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[EDRRR]		= 0x0010,
228c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TDLAR]		= 0x0018,
229c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RDLAR]		= 0x0020,
230c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[EESR]		= 0x0028,
231c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[EESIPR]	= 0x0030,
232c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TRSCER]	= 0x0038,
233c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RMFCR]		= 0x0040,
234c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TFTR]		= 0x0048,
235c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FDR]		= 0x0050,
236c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RMCR]		= 0x0058,
237c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TFUCR]		= 0x0064,
238c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RFOCR]		= 0x0068,
239c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FCFTR]		= 0x0070,
240c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RPADIR]	= 0x0078,
241c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TRIMD]		= 0x007c,
242c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RBWAR]		= 0x00c8,
243c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RDFAR]		= 0x00cc,
244c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TBRAR]		= 0x00d4,
245c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TDFAR]		= 0x00d8,
246c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov};
247c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov
248c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyovstatic const u16 sh_eth_offset_fast_sh3_sh2[SH_ETH_MAX_REGISTER_OFFSET] = {
249c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[ECMR]		= 0x0160,
250c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[ECSR]		= 0x0164,
251c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[ECSIPR]	= 0x0168,
252c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[PIR]		= 0x016c,
253c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[MAHR]		= 0x0170,
254c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[MALR]		= 0x0174,
255c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RFLR]		= 0x0178,
256c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[PSR]		= 0x017c,
257c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TROCR]		= 0x0180,
258c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[CDCR]		= 0x0184,
259c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[LCCR]		= 0x0188,
260c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[CNDCR]		= 0x018c,
261c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[CEFCR]		= 0x0194,
262c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FRECR]		= 0x0198,
263c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSFRCR]	= 0x019c,
264c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TLFRCR]	= 0x01a0,
265c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RFCR]		= 0x01a4,
266c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[MAFCR]		= 0x01a8,
267c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[IPGR]		= 0x01b4,
268c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[APR]		= 0x01b8,
269c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[MPR]		= 0x01bc,
270c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TPAUSER]	= 0x01c4,
271c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[BCFR]		= 0x01cc,
272c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov
273c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[ARSTR]		= 0x0000,
274c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_CTRST]	= 0x0004,
275c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWEN0]	= 0x0010,
276c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWEN1]	= 0x0014,
277c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FCM]	= 0x0018,
278c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_BSYSL0]	= 0x0020,
279c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_BSYSL1]	= 0x0024,
280c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_PRISL0]	= 0x0028,
281c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_PRISL1]	= 0x002c,
282c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWSL0]	= 0x0030,
283c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWSL1]	= 0x0034,
284c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWSLC]	= 0x0038,
285c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_QTAGM0]	= 0x0040,
286c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_QTAGM1]	= 0x0044,
287c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_ADQT0]	= 0x0048,
288c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_ADQT1]	= 0x004c,
289c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWSR]	= 0x0050,
290c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_FWINMK]	= 0x0054,
291c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_ADSBSY]	= 0x0060,
292c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_TEN]	= 0x0064,
293c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_POST1]	= 0x0070,
294c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_POST2]	= 0x0074,
295c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_POST3]	= 0x0078,
296c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_POST4]	= 0x007c,
297c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov
298c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TXNLCR0]	= 0x0080,
299c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TXALCR0]	= 0x0084,
300c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RXNLCR0]	= 0x0088,
301c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RXALCR0]	= 0x008c,
302c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FWNLCR0]	= 0x0090,
303c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FWALCR0]	= 0x0094,
304c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TXNLCR1]	= 0x00a0,
305c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TXALCR1]	= 0x00a0,
306c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RXNLCR1]	= 0x00a8,
307c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[RXALCR1]	= 0x00ac,
308c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FWNLCR1]	= 0x00b0,
309c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[FWALCR1]	= 0x00b4,
310c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov
311c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_ADRH0]	= 0x0100,
312c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_ADRL0]	= 0x0104,
313c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov	[TSU_ADRL31]	= 0x01fc,
314c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov};
315c0013f6f8bbcb7605d591431444780d636dbe223Sergei Shtylyov
316dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsustatic int sh_eth_is_gether(struct sh_eth_private *mdp)
317dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu{
318dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu	if (mdp->reg_offset == sh_eth_offset_gigabit)
319dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		return 1;
320dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu	else
321dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		return 0;
322dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu}
323dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu
3248e994402ad5e6ae3d391c0935f9f1dc2eeb92a5eSergei Shtylyovstatic void sh_eth_select_mii(struct net_device *ndev)
3255e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu{
3265e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu	u32 value = 0x0;
3275e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
3285e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu
3295e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu	switch (mdp->phy_interface) {
3305e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu	case PHY_INTERFACE_MODE_GMII:
3315e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu		value = 0x2;
3325e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu		break;
3335e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu	case PHY_INTERFACE_MODE_MII:
3345e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu		value = 0x1;
3355e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu		break;
3365e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu	case PHY_INTERFACE_MODE_RMII:
3375e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu		value = 0x0;
3385e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu		break;
3395e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu	default:
3405e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu		pr_warn("PHY interface mode was not setup. Set to MII.\n");
3415e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu		value = 0x1;
3425e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu		break;
3435e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu	}
3445e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu
3455e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu	sh_eth_write(ndev, value, RMII_MII);
3465e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu}
3475e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu
3488e994402ad5e6ae3d391c0935f9f1dc2eeb92a5eSergei Shtylyovstatic void sh_eth_set_duplex(struct net_device *ndev)
34965ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda{
35065ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
35165ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda
35265ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	if (mdp->duplex) /* Full */
3534a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, sh_eth_read(ndev, ECMR) | ECMR_DM, ECMR);
35465ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	else		/* Half */
3554a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, sh_eth_read(ndev, ECMR) & ~ECMR_DM, ECMR);
35665ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda}
35765ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda
35804b0ed2ad49834fe47d3c4171ad189c688a222b9Nobuhiro Iwamatsu/* There is CPU dependent code */
359589ebdef7e3107401bf96a9c660753d397329ee9Sergei Shtylyovstatic void sh_eth_set_rate_r8a777x(struct net_device *ndev)
36065ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda{
36165ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
362d0418bb7123f44b23d69ac349eec7daf9103472fPhil Edworthy
363a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	switch (mdp->speed) {
364a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	case 10: /* 10BASE */
365a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov		sh_eth_write(ndev, sh_eth_read(ndev, ECMR) & ~ECMR_ELB, ECMR);
366a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov		break;
367a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	case 100:/* 100BASE */
368a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov		sh_eth_write(ndev, sh_eth_read(ndev, ECMR) | ECMR_ELB, ECMR);
369a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov		break;
370a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	default:
371a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov		break;
372a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	}
373a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov}
374a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov
375674853b222168f2066db028cad89ab52cbcdeee5Sergei Shtylyov/* R8A7778/9 */
376589ebdef7e3107401bf96a9c660753d397329ee9Sergei Shtylyovstatic struct sh_eth_cpu_data r8a777x_data = {
377a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	.set_duplex	= sh_eth_set_duplex,
378589ebdef7e3107401bf96a9c660753d397329ee9Sergei Shtylyov	.set_rate	= sh_eth_set_rate_r8a777x,
379a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov
380a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	.ecsr_value	= ECSR_PSRTO | ECSR_LCHNG | ECSR_ICD,
381a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	.ecsipr_value	= ECSIPR_PSRTOIP | ECSIPR_LCHNGIP | ECSIPR_ICDIP,
382a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	.eesipr_value	= 0x01ff009f,
383a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov
384a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	.tx_check	= EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | EESR_RTO,
385ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov	.eesr_err_check	= EESR_TWB | EESR_TABT | EESR_RABT | EESR_RFE |
386ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov			  EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE |
387ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov			  EESR_ECI,
388a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov
389a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	.apr		= 1,
390a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	.mpr		= 1,
391a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	.tpauser	= 1,
392a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	.hw_swap	= 1,
393a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov};
394a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov
3959c3beaabb951d672b1534c7f56f84054b088f879Sergei Shtylyovstatic void sh_eth_set_rate_sh7724(struct net_device *ndev)
396a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov{
397a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	struct sh_eth_private *mdp = netdev_priv(ndev);
39865ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda
39965ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	switch (mdp->speed) {
40065ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	case 10: /* 10BASE */
401a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov		sh_eth_write(ndev, sh_eth_read(ndev, ECMR) & ~ECMR_RTM, ECMR);
40265ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda		break;
40365ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	case 100:/* 100BASE */
404a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov		sh_eth_write(ndev, sh_eth_read(ndev, ECMR) | ECMR_RTM, ECMR);
40565ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda		break;
40665ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	default:
40765ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda		break;
40865ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	}
40965ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda}
41065ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda
41165ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda/* SH7724 */
4129c3beaabb951d672b1534c7f56f84054b088f879Sergei Shtylyovstatic struct sh_eth_cpu_data sh7724_data = {
41365ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	.set_duplex	= sh_eth_set_duplex,
4149c3beaabb951d672b1534c7f56f84054b088f879Sergei Shtylyov	.set_rate	= sh_eth_set_rate_sh7724,
41565ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda
41665ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	.ecsr_value	= ECSR_PSRTO | ECSR_LCHNG | ECSR_ICD,
41765ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	.ecsipr_value	= ECSIPR_PSRTOIP | ECSIPR_LCHNGIP | ECSIPR_ICDIP,
418a80c3de714bc4855747faf5f00e8203fb800e6bbSergei Shtylyov	.eesipr_value	= 0x01ff009f,
41965ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda
42065ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	.tx_check	= EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | EESR_RTO,
421ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov	.eesr_err_check	= EESR_TWB | EESR_TABT | EESR_RABT | EESR_RFE |
422ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov			  EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE |
423ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov			  EESR_ECI,
42465ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda
42565ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	.apr		= 1,
42665ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	.mpr		= 1,
42765ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	.tpauser	= 1,
42865ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda	.hw_swap	= 1,
429503914cf4a4b5dbe3f844e0a92f412ae99fde70eMagnus Damm	.rpadir		= 1,
430503914cf4a4b5dbe3f844e0a92f412ae99fde70eMagnus Damm	.rpadir_value	= 0x00020000, /* NET_IP_ALIGN assumed to be 2 */
43165ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda};
4325cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu
43324549e2a0f33628b5160eac16c6aebf1cfaf22f1Sergei Shtylyovstatic void sh_eth_set_rate_sh7757(struct net_device *ndev)
434f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda{
435f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
436f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda
437f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	switch (mdp->speed) {
438f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	case 10: /* 10BASE */
4394a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, 0, RTRATE);
440f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda		break;
441f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	case 100:/* 100BASE */
4424a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, 1, RTRATE);
443f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda		break;
444f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	default:
445f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda		break;
446f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	}
447f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda}
448f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda
449f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda/* SH7757 */
45024549e2a0f33628b5160eac16c6aebf1cfaf22f1Sergei Shtylyovstatic struct sh_eth_cpu_data sh7757_data = {
45124549e2a0f33628b5160eac16c6aebf1cfaf22f1Sergei Shtylyov	.set_duplex	= sh_eth_set_duplex,
45224549e2a0f33628b5160eac16c6aebf1cfaf22f1Sergei Shtylyov	.set_rate	= sh_eth_set_rate_sh7757,
453f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda
454f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	.eesipr_value	= DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
455f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	.rmcr_value	= 0x00000001,
456f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda
457f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	.tx_check	= EESR_FTC | EESR_CND | EESR_DLC | EESR_CD | EESR_RTO,
458ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov	.eesr_err_check	= EESR_TWB | EESR_TABT | EESR_RABT | EESR_RFE |
459ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov			  EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE |
460ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov			  EESR_ECI,
461f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda
4625b3dfd13ae8bdebea67c02612fe282baff850bb0Nobuhiro Iwamatsu	.irq_flags	= IRQF_SHARED,
463f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	.apr		= 1,
464f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	.mpr		= 1,
465f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	.tpauser	= 1,
466f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	.hw_swap	= 1,
467f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda	.no_ade		= 1,
4682e98e7974de208de0dab9e9969bd47576d07ff10Yoshihiro Shimoda	.rpadir		= 1,
4692e98e7974de208de0dab9e9969bd47576d07ff10Yoshihiro Shimoda	.rpadir_value   = 2 << 16,
470f29a3d040727a80c3307a2bea057206be049c305Yoshihiro Shimoda};
47165ac8851490ec97a96759af729132c96f925a795Yoshihiro Shimoda
472e403d295817cf9f8be3110eb7ee1a03981287495David S. Miller#define SH_GIGA_ETH_BASE	0xfee00000UL
4738fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda#define GIGA_MALR(port)		(SH_GIGA_ETH_BASE + 0x800 * (port) + 0x05c8)
4748fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda#define GIGA_MAHR(port)		(SH_GIGA_ETH_BASE + 0x800 * (port) + 0x05c0)
4758fcd496151b4354569283056076339239b86fabeYoshihiro Shimodastatic void sh_eth_chip_reset_giga(struct net_device *ndev)
4768fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda{
4778fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	int i;
4788fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	unsigned long mahr[2], malr[2];
4798fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda
4808fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	/* save MAHR and MALR */
4818fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	for (i = 0; i < 2; i++) {
482ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda		malr[i] = ioread32((void *)GIGA_MALR(i));
483ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda		mahr[i] = ioread32((void *)GIGA_MAHR(i));
4848fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	}
4858fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda
4868fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	/* reset device */
487ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda	iowrite32(ARSTR_ARSTR, (void *)(SH_GIGA_ETH_BASE + 0x1800));
4888fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	mdelay(1);
4898fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda
4908fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	/* restore MAHR and MALR */
4918fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	for (i = 0; i < 2; i++) {
492ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda		iowrite32(malr[i], (void *)GIGA_MALR(i));
493ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda		iowrite32(mahr[i], (void *)GIGA_MAHR(i));
4948fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	}
4958fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda}
4968fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda
4978fcd496151b4354569283056076339239b86fabeYoshihiro Shimodastatic void sh_eth_set_rate_giga(struct net_device *ndev)
4988fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda{
4998fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
5008fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda
5018fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	switch (mdp->speed) {
5028fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	case 10: /* 10BASE */
5038fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda		sh_eth_write(ndev, 0x00000000, GECMR);
5048fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda		break;
5058fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	case 100:/* 100BASE */
5068fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda		sh_eth_write(ndev, 0x00000010, GECMR);
5078fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda		break;
5088fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	case 1000: /* 1000BASE */
5098fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda		sh_eth_write(ndev, 0x00000020, GECMR);
5108fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda		break;
5118fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	default:
5128fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda		break;
5138fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	}
5148fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda}
5158fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda
5168fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda/* SH7757(GETHERC) */
51724549e2a0f33628b5160eac16c6aebf1cfaf22f1Sergei Shtylyovstatic struct sh_eth_cpu_data sh7757_data_giga = {
5188fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.chip_reset	= sh_eth_chip_reset_giga,
51904b0ed2ad49834fe47d3c4171ad189c688a222b9Nobuhiro Iwamatsu	.set_duplex	= sh_eth_set_duplex,
5208fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.set_rate	= sh_eth_set_rate_giga,
5218fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda
5228fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.ecsr_value	= ECSR_ICD | ECSR_MPD,
5238fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.ecsipr_value	= ECSIPR_LCHNGIP | ECSIPR_ICDIP | ECSIPR_MPDIP,
5248fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.eesipr_value	= DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
5258fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda
5268fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.tx_check	= EESR_TC1 | EESR_FTC,
527ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov	.eesr_err_check	= EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT |
528ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov			  EESR_RFE | EESR_RDE | EESR_RFRMER | EESR_TFE |
529ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov			  EESR_TDE | EESR_ECI,
5308fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.fdr_value	= 0x0000072f,
5318fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.rmcr_value	= 0x00000001,
5328fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda
5335b3dfd13ae8bdebea67c02612fe282baff850bb0Nobuhiro Iwamatsu	.irq_flags	= IRQF_SHARED,
5348fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.apr		= 1,
5358fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.mpr		= 1,
5368fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.tpauser	= 1,
5378fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.bculr		= 1,
5388fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.hw_swap	= 1,
5398fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.rpadir		= 1,
5408fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.rpadir_value   = 2 << 16,
5418fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.no_trimd	= 1,
5428fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda	.no_ade		= 1,
5433acbc9715a5ac8a2534a69eb3488b63b7c9fb1e2Yoshihiro Shimoda	.tsu		= 1,
5448fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda};
5458fcd496151b4354569283056076339239b86fabeYoshihiro Shimoda
546380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimodastatic void sh_eth_chip_reset(struct net_device *ndev)
547380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda{
5484986b996882d82c68ab54b822d7cfdd7dd35f19aYoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
5494986b996882d82c68ab54b822d7cfdd7dd35f19aYoshihiro Shimoda
550380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	/* reset device */
5514986b996882d82c68ab54b822d7cfdd7dd35f19aYoshihiro Shimoda	sh_eth_tsu_write(mdp, ARSTR_ARSTR, ARSTR);
552380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	mdelay(1);
553380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda}
554380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
555f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyovstatic void sh_eth_set_rate_gether(struct net_device *ndev)
556380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda{
557380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
558380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
559380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	switch (mdp->speed) {
560380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	case 10: /* 10BASE */
5614a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, GECMR_10, GECMR);
562380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		break;
563380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	case 100:/* 100BASE */
5644a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, GECMR_100, GECMR);
565380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		break;
566380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	case 1000: /* 1000BASE */
5674a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, GECMR_1000, GECMR);
568380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		break;
569380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	default:
570380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		break;
571380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	}
572380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda}
573380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
574f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov/* SH7734 */
575f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyovstatic struct sh_eth_cpu_data sh7734_data = {
576380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.chip_reset	= sh_eth_chip_reset,
577380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.set_duplex	= sh_eth_set_duplex,
578f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.set_rate	= sh_eth_set_rate_gether,
579f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov
580f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.ecsr_value	= ECSR_ICD | ECSR_MPD,
581f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.ecsipr_value	= ECSIPR_LCHNGIP | ECSIPR_ICDIP | ECSIPR_MPDIP,
582f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.eesipr_value	= DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
583f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov
584f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.tx_check	= EESR_TC1 | EESR_FTC,
585ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov	.eesr_err_check	= EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT |
586ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov			  EESR_RFE | EESR_RDE | EESR_RFRMER | EESR_TFE |
587ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov			  EESR_TDE | EESR_ECI,
588f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov
589f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.apr		= 1,
590f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.mpr		= 1,
591f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.tpauser	= 1,
592f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.bculr		= 1,
593f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.hw_swap	= 1,
594f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.no_trimd	= 1,
595f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.no_ade		= 1,
596f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.tsu		= 1,
597f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.hw_crc		= 1,
598f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.select_mii	= 1,
599f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov};
600f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov
601f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov/* SH7763 */
602f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyovstatic struct sh_eth_cpu_data sh7763_data = {
603f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.chip_reset	= sh_eth_chip_reset,
604f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.set_duplex	= sh_eth_set_duplex,
605f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	.set_rate	= sh_eth_set_rate_gether,
606380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
607380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.ecsr_value	= ECSR_ICD | ECSR_MPD,
608380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.ecsipr_value	= ECSIPR_LCHNGIP | ECSIPR_ICDIP | ECSIPR_MPDIP,
609380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.eesipr_value	= DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
610380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
611380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.tx_check	= EESR_TC1 | EESR_FTC,
612380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.eesr_err_check	= EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT | \
613380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda			  EESR_RDE | EESR_RFRMER | EESR_TFE | EESR_TDE | \
614380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda			  EESR_ECI,
615380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
616380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.apr		= 1,
617380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.mpr		= 1,
618380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.tpauser	= 1,
619380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.bculr		= 1,
620380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.hw_swap	= 1,
621380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.no_trimd	= 1,
622380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.no_ade		= 1,
6234986b996882d82c68ab54b822d7cfdd7dd35f19aYoshihiro Shimoda	.tsu		= 1,
6245b3dfd13ae8bdebea67c02612fe282baff850bb0Nobuhiro Iwamatsu	.irq_flags	= IRQF_SHARED,
625380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda};
626380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
627e5c9b4cd665106d9b5397114ea81a53059410b6aSergei Shtylyovstatic void sh_eth_chip_reset_r8a7740(struct net_device *ndev)
62873a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda{
62973a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
63073a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda
63173a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	/* reset device */
63273a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	sh_eth_tsu_write(mdp, ARSTR_ARSTR, ARSTR);
63373a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	mdelay(1);
63473a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda
6355e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu	sh_eth_select_mii(ndev);
63673a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda}
63773a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda
63873a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda/* R8A7740 */
639e5c9b4cd665106d9b5397114ea81a53059410b6aSergei Shtylyovstatic struct sh_eth_cpu_data r8a7740_data = {
640e5c9b4cd665106d9b5397114ea81a53059410b6aSergei Shtylyov	.chip_reset	= sh_eth_chip_reset_r8a7740,
64173a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	.set_duplex	= sh_eth_set_duplex,
642e5c9b4cd665106d9b5397114ea81a53059410b6aSergei Shtylyov	.set_rate	= sh_eth_set_rate_gether,
64373a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda
64473a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	.ecsr_value	= ECSR_ICD | ECSR_MPD,
64573a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	.ecsipr_value	= ECSIPR_LCHNGIP | ECSIPR_ICDIP | ECSIPR_MPDIP,
64673a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	.eesipr_value	= DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
64773a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda
64873a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	.tx_check	= EESR_TC1 | EESR_FTC,
649ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov	.eesr_err_check	= EESR_TWB1 | EESR_TWB | EESR_TABT | EESR_RABT |
650ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov			  EESR_RFE | EESR_RDE | EESR_RFRMER | EESR_TFE |
651ca8c35852138ee0585eaffe6b9f10a5261ea7771Sergei Shtylyov			  EESR_TDE | EESR_ECI,
65273a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda
65373a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	.apr		= 1,
65473a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	.mpr		= 1,
65573a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	.tpauser	= 1,
65673a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	.bculr		= 1,
65773a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	.hw_swap	= 1,
65873a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	.no_trimd	= 1,
65973a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	.no_ade		= 1,
66073a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda	.tsu		= 1,
6615e7a76be0e48217aff6b6f34bdcce4725db999e2Nobuhiro Iwamatsu	.select_mii	= 1,
662ac8025a643a0e0beb81f3f37ca693364c6b77858Sergei Shtylyov	.shift_rd0	= 1,
66373a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda};
66473a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda
665c18a79abe31f555ec3b363b5b8c1d003230053b6Sergei Shtylyovstatic struct sh_eth_cpu_data sh7619_data = {
666380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.eesipr_value	= DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
667380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
668380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.apr		= 1,
669380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.mpr		= 1,
670380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.tpauser	= 1,
671380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.hw_swap	= 1,
672380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda};
6737bbe150d8c57c59689c8c50fd7b9915f4a7e10daSergei Shtylyov
6747bbe150d8c57c59689c8c50fd7b9915f4a7e10daSergei Shtylyovstatic struct sh_eth_cpu_data sh771x_data = {
675380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	.eesipr_value	= DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff,
6764986b996882d82c68ab54b822d7cfdd7dd35f19aYoshihiro Shimoda	.tsu		= 1,
677380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda};
678380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
679380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimodastatic void sh_eth_set_default_cpu_data(struct sh_eth_cpu_data *cd)
680380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda{
681380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (!cd->ecsr_value)
682380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		cd->ecsr_value = DEFAULT_ECSR_INIT;
683380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
684380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (!cd->ecsipr_value)
685380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		cd->ecsipr_value = DEFAULT_ECSIPR_INIT;
686380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
687380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (!cd->fcftr_value)
688380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		cd->fcftr_value = DEFAULT_FIFO_F_D_RFF | \
689380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda				  DEFAULT_FIFO_F_D_RFD;
690380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
691380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (!cd->fdr_value)
692380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		cd->fdr_value = DEFAULT_FDR_INIT;
693380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
694380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (!cd->rmcr_value)
695380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		cd->rmcr_value = DEFAULT_RMCR_VALUE;
696380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
697380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (!cd->tx_check)
698380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		cd->tx_check = DEFAULT_TX_CHECK;
699380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
700380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (!cd->eesr_err_check)
701380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		cd->eesr_err_check = DEFAULT_EESR_ERR_CHECK;
702380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda}
703380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
7045cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsustatic int sh_eth_check_reset(struct net_device *ndev)
7055cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu{
7065cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu	int ret = 0;
7075cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu	int cnt = 100;
7085cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu
7095cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu	while (cnt > 0) {
7105cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu		if (!(sh_eth_read(ndev, EDMR) & 0x3))
7115cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu			break;
7125cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu		mdelay(1);
7135cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu		cnt--;
7145cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu	}
7159f8c4265bda4a6e9aa97041d5cfd91386f460b65Sergei Shtylyov	if (cnt <= 0) {
7169f8c4265bda4a6e9aa97041d5cfd91386f460b65Sergei Shtylyov		pr_err("Device reset failed\n");
7175cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu		ret = -ETIMEDOUT;
7185cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu	}
7195cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu	return ret;
720380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda}
721dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu
722dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsustatic int sh_eth_reset(struct net_device *ndev)
723dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu{
724dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
725dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu	int ret = 0;
726dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu
727dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu	if (sh_eth_is_gether(mdp)) {
728dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		sh_eth_write(ndev, EDSR_ENALL, EDSR);
729dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		sh_eth_write(ndev, sh_eth_read(ndev, EDMR) | EDMR_SRST_GETHER,
730dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu			     EDMR);
731dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu
732dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		ret = sh_eth_check_reset(ndev);
733dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		if (ret)
734dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu			goto out;
735dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu
736dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		/* Table Init */
737dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		sh_eth_write(ndev, 0x0, TDLAR);
738dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		sh_eth_write(ndev, 0x0, TDFAR);
739dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		sh_eth_write(ndev, 0x0, TDFXR);
740dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		sh_eth_write(ndev, 0x0, TDFFR);
741dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		sh_eth_write(ndev, 0x0, RDLAR);
742dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		sh_eth_write(ndev, 0x0, RDFAR);
743dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		sh_eth_write(ndev, 0x0, RDFXR);
744dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		sh_eth_write(ndev, 0x0, RDFFR);
745dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu
746dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		/* Reset HW CRC register */
747dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		if (mdp->cd->hw_crc)
748dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu			sh_eth_write(ndev, 0x0, CSMR);
749dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu
750dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		/* Select MII mode */
751dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		if (mdp->cd->select_mii)
752dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu			sh_eth_select_mii(ndev);
753dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu	} else {
754dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		sh_eth_write(ndev, sh_eth_read(ndev, EDMR) | EDMR_SRST_ETHER,
755dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu			     EDMR);
756dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		mdelay(3);
757dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu		sh_eth_write(ndev, sh_eth_read(ndev, EDMR) & ~EDMR_SRST_ETHER,
758dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu			     EDMR);
759dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu	}
760dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu
761dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsuout:
762dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu	return ret;
763dabdde9ea77d4a77094726c82468a3bd767fb29bNobuhiro Iwamatsu}
764380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
76573a0d907301ece200d32b4e8ba2da2ca296b507fYoshihiro Shimoda#if defined(CONFIG_CPU_SH4) || defined(CONFIG_ARCH_SHMOBILE)
766380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimodastatic void sh_eth_set_receive_align(struct sk_buff *skb)
767380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda{
768380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	int reserve;
769380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
770380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	reserve = SH4_SKB_RX_ALIGN - ((u32)skb->data & (SH4_SKB_RX_ALIGN - 1));
771380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (reserve)
772380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		skb_reserve(skb, reserve);
773380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda}
774380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda#else
775380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimodastatic void sh_eth_set_receive_align(struct sk_buff *skb)
776380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda{
777380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	skb_reserve(skb, SH2_SH3_SKB_RX_ALIGN);
778380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda}
779380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda#endif
780380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
781380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
78271557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato/* CPU <-> EDMAC endian convert */
78371557a37adb5df17631c493b3b7d912938c720b2Yoshinori Satostatic inline __u32 cpu_to_edmac(struct sh_eth_private *mdp, u32 x)
78471557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato{
78571557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	switch (mdp->edmac_endian) {
78671557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	case EDMAC_LITTLE_ENDIAN:
78771557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato		return cpu_to_le32(x);
78871557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	case EDMAC_BIG_ENDIAN:
78971557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato		return cpu_to_be32(x);
79071557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	}
79171557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	return x;
79271557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato}
79371557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato
79471557a37adb5df17631c493b3b7d912938c720b2Yoshinori Satostatic inline __u32 edmac_to_cpu(struct sh_eth_private *mdp, u32 x)
79571557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato{
79671557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	switch (mdp->edmac_endian) {
79771557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	case EDMAC_LITTLE_ENDIAN:
79871557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato		return le32_to_cpu(x);
79971557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	case EDMAC_BIG_ENDIAN:
80071557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato		return be32_to_cpu(x);
80171557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	}
80271557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	return x;
80371557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato}
80471557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato
80586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/*
80686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu * Program the hardware MAC address from dev->dev_addr.
80786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu */
80886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic void update_mac_address(struct net_device *ndev)
80986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
8104a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev,
8114a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		(ndev->dev_addr[0] << 24) | (ndev->dev_addr[1] << 16) |
8124a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		(ndev->dev_addr[2] << 8) | (ndev->dev_addr[3]), MAHR);
8134a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev,
8144a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		(ndev->dev_addr[4] << 8) | (ndev->dev_addr[5]), MALR);
81586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
81686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
81786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/*
81886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu * Get MAC address from SuperH MAC address register
81986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *
82086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu * SuperH's Ethernet device doesn't have 'ROM' to MAC address.
82186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu * This driver get MAC address that use by bootloader(U-boot or sh-ipl+g).
82286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu * When you want use this device, you must set MAC address in bootloader.
82386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu *
82486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu */
825748031f9fd2c06b28817d80761a5de97190cfd03Magnus Dammstatic void read_mac_address(struct net_device *ndev, unsigned char *mac)
82686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
827748031f9fd2c06b28817d80761a5de97190cfd03Magnus Damm	if (mac[0] || mac[1] || mac[2] || mac[3] || mac[4] || mac[5]) {
828748031f9fd2c06b28817d80761a5de97190cfd03Magnus Damm		memcpy(ndev->dev_addr, mac, 6);
829748031f9fd2c06b28817d80761a5de97190cfd03Magnus Damm	} else {
8304a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		ndev->dev_addr[0] = (sh_eth_read(ndev, MAHR) >> 24);
8314a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		ndev->dev_addr[1] = (sh_eth_read(ndev, MAHR) >> 16) & 0xFF;
8324a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		ndev->dev_addr[2] = (sh_eth_read(ndev, MAHR) >> 8) & 0xFF;
8334a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		ndev->dev_addr[3] = (sh_eth_read(ndev, MAHR) & 0xFF);
8344a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		ndev->dev_addr[4] = (sh_eth_read(ndev, MALR) >> 8) & 0xFF;
8354a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		ndev->dev_addr[5] = (sh_eth_read(ndev, MALR) & 0xFF);
836748031f9fd2c06b28817d80761a5de97190cfd03Magnus Damm	}
83786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
83886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
839c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimodastatic unsigned long sh_eth_get_edtrr_trns(struct sh_eth_private *mdp)
840c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda{
841c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda	if (sh_eth_is_gether(mdp))
842c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda		return EDTRR_TRNS_GETHER;
843c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda	else
844c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda		return EDTRR_TRNS_ETHER;
845c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda}
846c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda
84786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustruct bb_info {
848ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda	void (*set_gate)(void *addr);
84986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct mdiobb_ctrl ctrl;
850ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda	void *addr;
85186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	u32 mmd_msk;/* MMD */
85286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	u32 mdo_msk;
85386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	u32 mdi_msk;
85486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	u32 mdc_msk;
85586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu};
85686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
85786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* PHY bit set */
858ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimodastatic void bb_set(void *addr, u32 msk)
85986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
860ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda	iowrite32(ioread32(addr) | msk, addr);
86186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
86286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
86386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* PHY bit clear */
864ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimodastatic void bb_clr(void *addr, u32 msk)
86586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
866ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda	iowrite32((ioread32(addr) & ~msk), addr);
86786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
86886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
86986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* PHY bit read */
870ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimodastatic int bb_read(void *addr, u32 msk)
87186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
872ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda	return (ioread32(addr) & msk) != 0;
87386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
87486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
87586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* Data I/O pin control */
87686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic void sh_mmd_ctrl(struct mdiobb_ctrl *ctrl, int bit)
87786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
87886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl);
879b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda
880b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda	if (bitbang->set_gate)
881b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda		bitbang->set_gate(bitbang->addr);
882b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda
88386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (bit)
88486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		bb_set(bitbang->addr, bitbang->mmd_msk);
88586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	else
88686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		bb_clr(bitbang->addr, bitbang->mmd_msk);
88786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
88886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
88986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* Set bit data*/
89086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic void sh_set_mdio(struct mdiobb_ctrl *ctrl, int bit)
89186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
89286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl);
89386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
894b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda	if (bitbang->set_gate)
895b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda		bitbang->set_gate(bitbang->addr);
896b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda
89786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (bit)
89886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		bb_set(bitbang->addr, bitbang->mdo_msk);
89986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	else
90086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		bb_clr(bitbang->addr, bitbang->mdo_msk);
90186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
90286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
90386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* Get bit data*/
90486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic int sh_get_mdio(struct mdiobb_ctrl *ctrl)
90586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
90686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl);
907b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda
908b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda	if (bitbang->set_gate)
909b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda		bitbang->set_gate(bitbang->addr);
910b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda
91186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return bb_read(bitbang->addr, bitbang->mdi_msk);
91286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
91386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
91486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* MDC pin control */
91586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic void sh_mdc_ctrl(struct mdiobb_ctrl *ctrl, int bit)
91686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
91786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl);
91886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
919b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda	if (bitbang->set_gate)
920b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda		bitbang->set_gate(bitbang->addr);
921b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda
92286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (bit)
92386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		bb_set(bitbang->addr, bitbang->mdc_msk);
92486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	else
92586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		bb_clr(bitbang->addr, bitbang->mdc_msk);
92686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
92786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
92886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* mdio bus control struct */
92986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic struct mdiobb_ops bb_ops = {
93086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	.owner = THIS_MODULE,
93186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	.set_mdc = sh_mdc_ctrl,
93286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	.set_mdio_dir = sh_mmd_ctrl,
93386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	.set_mdio_data = sh_set_mdio,
93486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	.get_mdio_data = sh_get_mdio,
93586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu};
93686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
93786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* free skb and descriptor buffer */
93886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic void sh_eth_ring_free(struct net_device *ndev)
93986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
94086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
94186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	int i;
94286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
94386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Free Rx skb ringbuffer */
94486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (mdp->rx_skbuff) {
945525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		for (i = 0; i < mdp->num_rx_ring; i++) {
94686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			if (mdp->rx_skbuff[i])
94786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu				dev_kfree_skb(mdp->rx_skbuff[i]);
94886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		}
94986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
95086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	kfree(mdp->rx_skbuff);
95191c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda	mdp->rx_skbuff = NULL;
95286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
95386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Free Tx skb ringbuffer */
95486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (mdp->tx_skbuff) {
955525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		for (i = 0; i < mdp->num_tx_ring; i++) {
95686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			if (mdp->tx_skbuff[i])
95786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu				dev_kfree_skb(mdp->tx_skbuff[i]);
95886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		}
95986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
96086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	kfree(mdp->tx_skbuff);
96191c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda	mdp->tx_skbuff = NULL;
96286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
96386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
96486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* format skb and descriptor buffer */
96586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic void sh_eth_ring_format(struct net_device *ndev)
96686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
96786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
96886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	int i;
96986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sk_buff *skb;
97086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_rxdesc *rxdesc = NULL;
97186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_txdesc *txdesc = NULL;
972525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	int rx_ringsize = sizeof(*rxdesc) * mdp->num_rx_ring;
973525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	int tx_ringsize = sizeof(*txdesc) * mdp->num_tx_ring;
97486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
97586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp->cur_rx = mdp->cur_tx = 0;
97686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp->dirty_rx = mdp->dirty_tx = 0;
97786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
97886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	memset(mdp->rx_ring, 0, rx_ringsize);
97986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
98086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* build Rx ring buffer */
981525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	for (i = 0; i < mdp->num_rx_ring; i++) {
98286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		/* skb */
98386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		mdp->rx_skbuff[i] = NULL;
984dae2e9f430c46c29e3f771110094bd3da3625aa4Pradeep A. Dalvi		skb = netdev_alloc_skb(ndev, mdp->rx_buf_sz);
98586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		mdp->rx_skbuff[i] = skb;
98686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (skb == NULL)
98786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			break;
988bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet		dma_map_single(&ndev->dev, skb->data, mdp->rx_buf_sz,
989e88aae7bb1dc50457489d1d7c81dcf4db23ccf94Yoshihiro Shimoda				DMA_FROM_DEVICE);
990380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		sh_eth_set_receive_align(skb);
991380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
99286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		/* RX descriptor */
99386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		rxdesc = &mdp->rx_ring[i];
9940029d64af5d72049e2170e4609fa83bd1f3f07cdYoshihiro Shimoda		rxdesc->addr = virt_to_phys(PTR_ALIGN(skb->data, 4));
99571557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato		rxdesc->status = cpu_to_edmac(mdp, RD_RACT | RD_RFP);
99686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
99786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		/* The size of the buffer is 16 byte boundary. */
9980029d64af5d72049e2170e4609fa83bd1f3f07cdYoshihiro Shimoda		rxdesc->buffer_length = ALIGN(mdp->rx_buf_sz, 16);
999b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu		/* Rx descriptor address set */
1000b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu		if (i == 0) {
10014a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda			sh_eth_write(ndev, mdp->rx_desc_dma, RDLAR);
1002c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda			if (sh_eth_is_gether(mdp))
1003c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda				sh_eth_write(ndev, mdp->rx_desc_dma, RDFAR);
1004b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu		}
100586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
100686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1007525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	mdp->dirty_rx = (u32) (i - mdp->num_rx_ring);
100886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
100986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Mark the last entry as wrapping the ring. */
101071557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	rxdesc->status |= cpu_to_edmac(mdp, RD_RDEL);
101186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
101286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	memset(mdp->tx_ring, 0, tx_ringsize);
101386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
101486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* build Tx ring buffer */
1015525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	for (i = 0; i < mdp->num_tx_ring; i++) {
101686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		mdp->tx_skbuff[i] = NULL;
101786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		txdesc = &mdp->tx_ring[i];
101871557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato		txdesc->status = cpu_to_edmac(mdp, TD_TFP);
101986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		txdesc->buffer_length = 0;
1020b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu		if (i == 0) {
102171557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato			/* Tx descriptor address set */
10224a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda			sh_eth_write(ndev, mdp->tx_desc_dma, TDLAR);
1023c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda			if (sh_eth_is_gether(mdp))
1024c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda				sh_eth_write(ndev, mdp->tx_desc_dma, TDFAR);
1025b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu		}
102686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
102786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
102871557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	txdesc->status |= cpu_to_edmac(mdp, TD_TDLE);
102986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
103086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
103186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* Get skb and descriptor buffer */
103286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic int sh_eth_ring_init(struct net_device *ndev)
103386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
103486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
103586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	int rx_ringsize, tx_ringsize, ret = 0;
103686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
103786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/*
103886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	 * +26 gets the maximum ethernet encapsulation, +7 & ~7 because the
103986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	 * card needs room to do 8 byte alignment, +2 so we can reserve
104086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	 * the first 2 bytes, and +16 gets room for the status word from the
104186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	 * card.
104286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	 */
104386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp->rx_buf_sz = (ndev->mtu <= 1492 ? PKT_BUF_SZ :
104486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			  (((ndev->mtu + 26 + 7) & ~7) + 2 + 16));
1045503914cf4a4b5dbe3f844e0a92f412ae99fde70eMagnus Damm	if (mdp->cd->rpadir)
1046503914cf4a4b5dbe3f844e0a92f412ae99fde70eMagnus Damm		mdp->rx_buf_sz += NET_IP_ALIGN;
104786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
104886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Allocate RX and TX skb rings */
1049b2adaca92c63b9bb8beb021d554f656e387a7648Joe Perches	mdp->rx_skbuff = kmalloc_array(mdp->num_rx_ring,
1050b2adaca92c63b9bb8beb021d554f656e387a7648Joe Perches				       sizeof(*mdp->rx_skbuff), GFP_KERNEL);
105186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (!mdp->rx_skbuff) {
105286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		ret = -ENOMEM;
105386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		return ret;
105486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
105586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1056b2adaca92c63b9bb8beb021d554f656e387a7648Joe Perches	mdp->tx_skbuff = kmalloc_array(mdp->num_tx_ring,
1057b2adaca92c63b9bb8beb021d554f656e387a7648Joe Perches				       sizeof(*mdp->tx_skbuff), GFP_KERNEL);
105886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (!mdp->tx_skbuff) {
105986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		ret = -ENOMEM;
106086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		goto skb_ring_free;
106186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
106286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
106386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Allocate all Rx descriptors. */
1064525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	rx_ringsize = sizeof(struct sh_eth_rxdesc) * mdp->num_rx_ring;
106586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp->rx_ring = dma_alloc_coherent(NULL, rx_ringsize, &mdp->rx_desc_dma,
1066d0320f750093d012d3ed69fc1e8b385f654523d5Joe Perches					  GFP_KERNEL);
106786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (!mdp->rx_ring) {
106886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		ret = -ENOMEM;
106986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		goto desc_ring_free;
107086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
107186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
107286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp->dirty_rx = 0;
107386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
107486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Allocate all Tx descriptors. */
1075525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	tx_ringsize = sizeof(struct sh_eth_txdesc) * mdp->num_tx_ring;
107686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp->tx_ring = dma_alloc_coherent(NULL, tx_ringsize, &mdp->tx_desc_dma,
1077d0320f750093d012d3ed69fc1e8b385f654523d5Joe Perches					  GFP_KERNEL);
107886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (!mdp->tx_ring) {
107986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		ret = -ENOMEM;
108086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		goto desc_ring_free;
108186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
108286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return ret;
108386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
108486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsudesc_ring_free:
108586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* free DMA buffer */
108686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	dma_free_coherent(NULL, rx_ringsize, mdp->rx_ring, mdp->rx_desc_dma);
108786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
108886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsuskb_ring_free:
108986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Free Rx and Tx skb ring buffer */
109086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	sh_eth_ring_free(ndev);
109191c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda	mdp->tx_ring = NULL;
109291c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda	mdp->rx_ring = NULL;
109386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
109486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return ret;
109586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
109686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
109791c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimodastatic void sh_eth_free_dma_buffer(struct sh_eth_private *mdp)
109891c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda{
109991c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda	int ringsize;
110091c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda
110191c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda	if (mdp->rx_ring) {
1102525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		ringsize = sizeof(struct sh_eth_rxdesc) * mdp->num_rx_ring;
110391c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda		dma_free_coherent(NULL, ringsize, mdp->rx_ring,
110491c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda				  mdp->rx_desc_dma);
110591c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda		mdp->rx_ring = NULL;
110691c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda	}
110791c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda
110891c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda	if (mdp->tx_ring) {
1109525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		ringsize = sizeof(struct sh_eth_txdesc) * mdp->num_tx_ring;
111091c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda		dma_free_coherent(NULL, ringsize, mdp->tx_ring,
111191c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda				  mdp->tx_desc_dma);
111291c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda		mdp->tx_ring = NULL;
111391c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda	}
111491c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda}
111591c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda
1116525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimodastatic int sh_eth_dev_init(struct net_device *ndev, bool start)
111786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
111886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	int ret = 0;
111986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
112086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	u32 val;
112186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
112286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Soft Reset */
11235cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu	ret = sh_eth_reset(ndev);
11245cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu	if (ret)
11255cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsu		goto out;
112686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1127b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu	/* Descriptor format */
1128b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu	sh_eth_ring_format(ndev);
1129380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (mdp->cd->rpadir)
11304a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, mdp->cd->rpadir_value, RPADIR);
113186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
113286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* all sh_eth int mask */
11334a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, 0, EESIPR);
113486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
113510b9194f959608368ed89df1937f17cfe6bd6d84Yoshihiro Shimoda#if defined(__LITTLE_ENDIAN)
1136380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (mdp->cd->hw_swap)
11374a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, EDMR_EL, EDMR);
1138380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	else
1139b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu#endif
11404a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, 0, EDMR);
114186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1142b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu	/* FIFO size set */
11434a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, mdp->cd->fdr_value, FDR);
11444a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, 0, TFTR);
114586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1146b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu	/* Frame recv control */
11474a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, mdp->cd->rmcr_value, RMCR);
114886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
11492ecbb783c3bf5a63f555c39deef308dcc1902b7fYoshihiro Shimoda	sh_eth_write(ndev, DESC_I_RINT8 | DESC_I_RINT5 | DESC_I_TINT2, TRSCER);
115086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1151380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (mdp->cd->bculr)
11524a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, 0x800, BCULR);	/* Burst sycle set */
1153b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu
11544a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, mdp->cd->fcftr_value, FCFTR);
115586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1156380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (!mdp->cd->no_trimd)
11574a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, 0, TRIMD);
115886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1159b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu	/* Recv frame limit set register */
1160fdb37a7f84a58ccad24abffd54ad46d23b763e13Yoshihiro Shimoda	sh_eth_write(ndev, ndev->mtu + ETH_HLEN + VLAN_HLEN + ETH_FCS_LEN,
1161fdb37a7f84a58ccad24abffd54ad46d23b763e13Yoshihiro Shimoda		     RFLR);
116286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
11634a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, sh_eth_read(ndev, EESR), EESR);
1164525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	if (start)
1165525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		sh_eth_write(ndev, mdp->cd->eesipr_value, EESIPR);
116686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
116786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* PAUSE Prohibition */
11684a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	val = (sh_eth_read(ndev, ECMR) & ECMR_DM) |
116986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		ECMR_ZPF | (mdp->duplex ? ECMR_DM : 0) | ECMR_TE | ECMR_RE;
117086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
11714a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, val, ECMR);
1172b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu
1173380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (mdp->cd->set_rate)
1174380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		mdp->cd->set_rate(ndev);
1175380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
1176b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu	/* E-MAC Status Register clear */
11774a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, mdp->cd->ecsr_value, ECSR);
1178b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu
1179b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu	/* E-MAC Interrupt Enable register */
1180525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	if (start)
1181525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		sh_eth_write(ndev, mdp->cd->ecsipr_value, ECSIPR);
118286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
118386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Set MAC address */
118486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	update_mac_address(ndev);
118586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
118686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* mask reset */
1187380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (mdp->cd->apr)
11884a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, APR_AP, APR);
1189380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (mdp->cd->mpr)
11904a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, MPR_MP, MPR);
1191380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (mdp->cd->tpauser)
11924a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, TPAUSER_UNLIMITED, TPAUSER);
1193b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu
1194525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	if (start) {
1195525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		/* Setting the Rx mode will start the Rx process. */
1196525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		sh_eth_write(ndev, EDRRR_R, EDRRR);
119786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1198525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		netif_start_queue(ndev);
1199525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	}
120086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
12015cee1d37c9f565f1aa515408863dbb13db67dab9Nobuhiro Iwamatsuout:
120286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return ret;
120386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
120486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
120586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* free Tx skb function */
120686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic int sh_eth_txfree(struct net_device *ndev)
120786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
120886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
120986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_txdesc *txdesc;
121086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	int freeNum = 0;
121186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	int entry = 0;
121286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
121386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	for (; mdp->cur_tx - mdp->dirty_tx > 0; mdp->dirty_tx++) {
1214525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		entry = mdp->dirty_tx % mdp->num_tx_ring;
121586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		txdesc = &mdp->tx_ring[entry];
121671557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato		if (txdesc->status & cpu_to_edmac(mdp, TD_TACT))
121786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			break;
121886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		/* Free the original skb. */
121986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (mdp->tx_skbuff[entry]) {
122031fcb99d9958bdf04e84224e202f69e6cdac893bYoshihiro Shimoda			dma_unmap_single(&ndev->dev, txdesc->addr,
122131fcb99d9958bdf04e84224e202f69e6cdac893bYoshihiro Shimoda					 txdesc->buffer_length, DMA_TO_DEVICE);
122286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			dev_kfree_skb_irq(mdp->tx_skbuff[entry]);
122386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			mdp->tx_skbuff[entry] = NULL;
122486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			freeNum++;
122586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		}
122671557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato		txdesc->status = cpu_to_edmac(mdp, TD_TFP);
1227525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		if (entry >= mdp->num_tx_ring - 1)
122871557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato			txdesc->status |= cpu_to_edmac(mdp, TD_TDLE);
122986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1230bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet		ndev->stats.tx_packets++;
1231bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet		ndev->stats.tx_bytes += txdesc->buffer_length;
123286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
123386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return freeNum;
123486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
123586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
123686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* Packet receive function */
12373719109d61ca96746c733538ec776d02a6952640Sergei Shtylyovstatic int sh_eth_rx(struct net_device *ndev, u32 intr_status, int *quota)
123886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
123986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
124086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_rxdesc *rxdesc;
124186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1242525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	int entry = mdp->cur_rx % mdp->num_rx_ring;
1243525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	int boguscnt = (mdp->dirty_rx + mdp->num_rx_ring) - mdp->cur_rx;
124486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sk_buff *skb;
12453719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	int exceeded = 0;
124686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	u16 pkt_len = 0;
1247380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	u32 desc_status;
124886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
124986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	rxdesc = &mdp->rx_ring[entry];
125071557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	while (!(rxdesc->status & cpu_to_edmac(mdp, RD_RACT))) {
125171557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato		desc_status = edmac_to_cpu(mdp, rxdesc->status);
125286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		pkt_len = rxdesc->frame_length;
125386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
125486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (--boguscnt < 0)
125586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			break;
125686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
12573719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		if (*quota <= 0) {
12583719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov			exceeded = 1;
12593719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov			break;
12603719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		}
12613719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		(*quota)--;
12623719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov
126386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (!(desc_status & RDFEND))
1264bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet			ndev->stats.rx_length_errors++;
126586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1266dd019897358b815f7828dab90b51d51df4d3658dYoshihiro Shimoda		/*
1267dd019897358b815f7828dab90b51d51df4d3658dYoshihiro Shimoda		 * In case of almost all GETHER/ETHERs, the Receive Frame State
1268dd019897358b815f7828dab90b51d51df4d3658dYoshihiro Shimoda		 * (RFS) bits in the Receive Descriptor 0 are from bit 9 to
1269dd019897358b815f7828dab90b51d51df4d3658dYoshihiro Shimoda		 * bit 0. However, in case of the R8A7740's GETHER, the RFS
1270dd019897358b815f7828dab90b51d51df4d3658dYoshihiro Shimoda		 * bits are from bit 25 to bit 16. So, the driver needs right
1271dd019897358b815f7828dab90b51d51df4d3658dYoshihiro Shimoda		 * shifting by 16.
1272dd019897358b815f7828dab90b51d51df4d3658dYoshihiro Shimoda		 */
1273ac8025a643a0e0beb81f3f37ca693364c6b77858Sergei Shtylyov		if (mdp->cd->shift_rd0)
1274ac8025a643a0e0beb81f3f37ca693364c6b77858Sergei Shtylyov			desc_status >>= 16;
1275dd019897358b815f7828dab90b51d51df4d3658dYoshihiro Shimoda
127686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (desc_status & (RD_RFS1 | RD_RFS2 | RD_RFS3 | RD_RFS4 |
127786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu				   RD_RFS5 | RD_RFS6 | RD_RFS10)) {
1278bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet			ndev->stats.rx_errors++;
127986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			if (desc_status & RD_RFS1)
1280bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet				ndev->stats.rx_crc_errors++;
128186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			if (desc_status & RD_RFS2)
1282bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet				ndev->stats.rx_frame_errors++;
128386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			if (desc_status & RD_RFS3)
1284bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet				ndev->stats.rx_length_errors++;
128586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			if (desc_status & RD_RFS4)
1286bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet				ndev->stats.rx_length_errors++;
128786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			if (desc_status & RD_RFS6)
1288bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet				ndev->stats.rx_missed_errors++;
128986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			if (desc_status & RD_RFS10)
1290bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet				ndev->stats.rx_over_errors++;
129186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		} else {
1292380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda			if (!mdp->cd->hw_swap)
1293380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda				sh_eth_soft_swap(
1294380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda					phys_to_virt(ALIGN(rxdesc->addr, 4)),
1295380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda					pkt_len + 2);
129686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			skb = mdp->rx_skbuff[entry];
129786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			mdp->rx_skbuff[entry] = NULL;
1298503914cf4a4b5dbe3f844e0a92f412ae99fde70eMagnus Damm			if (mdp->cd->rpadir)
1299503914cf4a4b5dbe3f844e0a92f412ae99fde70eMagnus Damm				skb_reserve(skb, NET_IP_ALIGN);
130086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			skb_put(skb, pkt_len);
130186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			skb->protocol = eth_type_trans(skb, ndev);
1302a8e9fd0f7462f5cada5189513d12fe6c9cce2105Sergei Shtylyov			netif_receive_skb(skb);
1303bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet			ndev->stats.rx_packets++;
1304bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet			ndev->stats.rx_bytes += pkt_len;
130586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		}
130671557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato		rxdesc->status |= cpu_to_edmac(mdp, RD_RACT);
1307525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		entry = (++mdp->cur_rx) % mdp->num_rx_ring;
1308862df49750e7ca9369c04d8d8105b3cc5d976e0dYoshihiro Shimoda		rxdesc = &mdp->rx_ring[entry];
130986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
131086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
131186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Refill the Rx ring buffers. */
131286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	for (; mdp->cur_rx - mdp->dirty_rx > 0; mdp->dirty_rx++) {
1313525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		entry = mdp->dirty_rx % mdp->num_rx_ring;
131486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		rxdesc = &mdp->rx_ring[entry];
1315b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu		/* The size of the buffer is 16 byte boundary. */
13160029d64af5d72049e2170e4609fa83bd1f3f07cdYoshihiro Shimoda		rxdesc->buffer_length = ALIGN(mdp->rx_buf_sz, 16);
1317b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu
131886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (mdp->rx_skbuff[entry] == NULL) {
1319dae2e9f430c46c29e3f771110094bd3da3625aa4Pradeep A. Dalvi			skb = netdev_alloc_skb(ndev, mdp->rx_buf_sz);
132086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			mdp->rx_skbuff[entry] = skb;
132186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			if (skb == NULL)
132286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu				break;	/* Better luck next round. */
1323bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet			dma_map_single(&ndev->dev, skb->data, mdp->rx_buf_sz,
1324e88aae7bb1dc50457489d1d7c81dcf4db23ccf94Yoshihiro Shimoda					DMA_FROM_DEVICE);
1325380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda			sh_eth_set_receive_align(skb);
1326380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
1327bc8acf2c8c3e43fcc192762a9f964b3e9a17748bEric Dumazet			skb_checksum_none_assert(skb);
13280029d64af5d72049e2170e4609fa83bd1f3f07cdYoshihiro Shimoda			rxdesc->addr = virt_to_phys(PTR_ALIGN(skb->data, 4));
132986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		}
1330525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		if (entry >= mdp->num_rx_ring - 1)
133186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			rxdesc->status |=
133271557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato				cpu_to_edmac(mdp, RD_RACT | RD_RFP | RD_RDEL);
133386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		else
133486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			rxdesc->status |=
133571557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato				cpu_to_edmac(mdp, RD_RACT | RD_RFP);
133686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
133786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
133886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Restart Rx engine if stopped. */
133986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* If we don't need to check status, don't. -KDU */
134079fba9f51755c704c0a7d7b7f0df10874dc0a744Yoshihiro Shimoda	if (!(sh_eth_read(ndev, EDRRR) & EDRRR_R)) {
1341a18e08bdcf845efb7344cea146e683df746bbfb4Yoshihiro Shimoda		/* fix the values for the next receiving if RDE is set */
1342a18e08bdcf845efb7344cea146e683df746bbfb4Yoshihiro Shimoda		if (intr_status & EESR_RDE)
1343a18e08bdcf845efb7344cea146e683df746bbfb4Yoshihiro Shimoda			mdp->cur_rx = mdp->dirty_rx =
1344a18e08bdcf845efb7344cea146e683df746bbfb4Yoshihiro Shimoda				(sh_eth_read(ndev, RDFAR) -
1345a18e08bdcf845efb7344cea146e683df746bbfb4Yoshihiro Shimoda				 sh_eth_read(ndev, RDLAR)) >> 4;
13464a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, EDRRR_R, EDRRR);
134779fba9f51755c704c0a7d7b7f0df10874dc0a744Yoshihiro Shimoda	}
134886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
13493719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	return exceeded;
135086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
135186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
13524a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimodastatic void sh_eth_rcv_snd_disable(struct net_device *ndev)
1353dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu{
1354dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	/* disable tx and rx */
13554a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, sh_eth_read(ndev, ECMR) &
13564a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		~(ECMR_RE | ECMR_TE), ECMR);
1357dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu}
1358dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
13594a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimodastatic void sh_eth_rcv_snd_enable(struct net_device *ndev)
1360dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu{
1361dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	/* enable tx and rx */
13624a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, sh_eth_read(ndev, ECMR) |
13634a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		(ECMR_RE | ECMR_TE), ECMR);
1364dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu}
1365dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
136686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* error control function */
136786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic void sh_eth_error(struct net_device *ndev, int intr_status)
136886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
136986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
137086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	u32 felic_stat;
1371380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	u32 link_stat;
1372380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	u32 mask;
137386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
137486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (intr_status & EESR_ECI) {
13754a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		felic_stat = sh_eth_read(ndev, ECSR);
13764a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		sh_eth_write(ndev, felic_stat, ECSR);	/* clear int */
137786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (felic_stat & ECSR_ICD)
1378bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet			ndev->stats.tx_carrier_errors++;
137986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (felic_stat & ECSR_LCHNG) {
138086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			/* Link Changed */
13814923576b8ac5bfd36ab2beb176aeb747aaab7e41Yoshihiro Shimoda			if (mdp->cd->no_psr || mdp->no_ether_link) {
13821e1b812bbe1069fc8e2e372dca7d5f541c7a8cebSergei Shtylyov				goto ignore_link;
1383380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda			} else {
13844a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda				link_stat = (sh_eth_read(ndev, PSR));
13854923576b8ac5bfd36ab2beb176aeb747aaab7e41Yoshihiro Shimoda				if (mdp->ether_link_active_low)
13864923576b8ac5bfd36ab2beb176aeb747aaab7e41Yoshihiro Shimoda					link_stat = ~link_stat;
1387380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda			}
1388dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu			if (!(link_stat & PHY_ST_LINK))
13894a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda				sh_eth_rcv_snd_disable(ndev);
1390dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu			else {
139186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu				/* Link Up */
13924a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda				sh_eth_write(ndev, sh_eth_read(ndev, EESIPR) &
13934a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda					  ~DMAC_M_ECI, EESIPR);
139486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu				/*clear int */
13954a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda				sh_eth_write(ndev, sh_eth_read(ndev, ECSR),
13964a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda					  ECSR);
13974a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda				sh_eth_write(ndev, sh_eth_read(ndev, EESIPR) |
13984a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda					  DMAC_M_ECI, EESIPR);
139986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu				/* enable tx and rx */
14004a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda				sh_eth_rcv_snd_enable(ndev);
140186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			}
140286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		}
140386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
140486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
14051e1b812bbe1069fc8e2e372dca7d5f541c7a8cebSergei Shtylyovignore_link:
140686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (intr_status & EESR_TWB) {
14074eb313a7a939a983c525648227b5fe0a9d41679fSergei Shtylyov		/* Unused write back interrupt */
14084eb313a7a939a983c525648227b5fe0a9d41679fSergei Shtylyov		if (intr_status & EESR_TABT) {	/* Transmit Abort int */
1409bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet			ndev->stats.tx_aborted_errors++;
1410dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu			if (netif_msg_tx_err(mdp))
1411dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu				dev_err(&ndev->dev, "Transmit Abort\n");
14124eb313a7a939a983c525648227b5fe0a9d41679fSergei Shtylyov		}
141386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
141486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
141586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (intr_status & EESR_RABT) {
141686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		/* Receive Abort int */
141786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (intr_status & EESR_RFRMER) {
141886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			/* Receive Frame Overflow int */
1419bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet			ndev->stats.rx_frame_errors++;
1420dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu			if (netif_msg_rx_err(mdp))
1421dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu				dev_err(&ndev->dev, "Receive Abort\n");
142286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		}
142386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
1424380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
1425dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	if (intr_status & EESR_TDE) {
1426dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		/* Transmit Descriptor Empty int */
1427bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet		ndev->stats.tx_fifo_errors++;
1428dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		if (netif_msg_tx_err(mdp))
1429dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu			dev_err(&ndev->dev, "Transmit Descriptor Empty\n");
1430dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	}
1431dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1432dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	if (intr_status & EESR_TFE) {
1433dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		/* FIFO under flow */
1434bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet		ndev->stats.tx_fifo_errors++;
1435dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		if (netif_msg_tx_err(mdp))
1436dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu			dev_err(&ndev->dev, "Transmit FIFO Under flow\n");
143786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
143886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
143986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (intr_status & EESR_RDE) {
144086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		/* Receive Descriptor Empty int */
1441bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet		ndev->stats.rx_over_errors++;
144286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1443dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		if (netif_msg_rx_err(mdp))
1444dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu			dev_err(&ndev->dev, "Receive Descriptor Empty\n");
144586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
1446dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
144786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (intr_status & EESR_RFE) {
144886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		/* Receive FIFO Overflow int */
1449bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet		ndev->stats.rx_fifo_errors++;
1450dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		if (netif_msg_rx_err(mdp))
1451dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu			dev_err(&ndev->dev, "Receive FIFO Overflow\n");
1452dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	}
1453dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1454dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	if (!mdp->cd->no_ade && (intr_status & EESR_ADE)) {
1455dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		/* Address Error */
1456bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet		ndev->stats.tx_fifo_errors++;
1457dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		if (netif_msg_tx_err(mdp))
1458dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu			dev_err(&ndev->dev, "Address Error\n");
145986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
1460380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
1461380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	mask = EESR_TWB | EESR_TABT | EESR_ADE | EESR_TDE | EESR_TFE;
1462380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (mdp->cd->no_ade)
1463380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		mask &= ~EESR_ADE;
1464380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (intr_status & mask) {
146586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		/* Tx error */
14664a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		u32 edtrr = sh_eth_read(ndev, EDTRR);
146786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		/* dmesg */
1468380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		dev_err(&ndev->dev, "TX error. status=%8.8x cur_tx=%8.8x ",
1469380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda				intr_status, mdp->cur_tx);
1470380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		dev_err(&ndev->dev, "dirty_tx=%8.8x state=%8.8x EDTRR=%8.8x.\n",
147186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu				mdp->dirty_tx, (u32) ndev->state, edtrr);
147286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		/* dirty buffer free */
147386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		sh_eth_txfree(ndev);
147486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
147586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		/* SH7712 BUG */
1476c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda		if (edtrr ^ sh_eth_get_edtrr_trns(mdp)) {
147786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			/* tx dma start */
1478c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda			sh_eth_write(ndev, sh_eth_get_edtrr_trns(mdp), EDTRR);
147986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		}
148086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		/* wakeup */
148186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		netif_wake_queue(ndev);
148286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
148386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
148486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
148586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic irqreturn_t sh_eth_interrupt(int irq, void *netdev)
148686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
148786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct net_device *ndev = netdev;
148886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
1489380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	struct sh_eth_cpu_data *cd = mdp->cd;
14900e0fde3c8d65524b8dfd834332d6e4a92711a66aNobuhiro Iwamatsu	irqreturn_t ret = IRQ_NONE;
14913719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	unsigned long intr_status, intr_enable;
149286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
149386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	spin_lock(&mdp->lock);
149486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
14953893b27345ac0ff13c1b9ec20ad50966b810997eSergei Shtylyov	/* Get interrupt status */
14964a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	intr_status = sh_eth_read(ndev, EESR);
14973893b27345ac0ff13c1b9ec20ad50966b810997eSergei Shtylyov	/* Mask it with the interrupt mask, forcing ECI interrupt to be always
14983893b27345ac0ff13c1b9ec20ad50966b810997eSergei Shtylyov	 * enabled since it's the one that  comes thru regardless of the mask,
14993893b27345ac0ff13c1b9ec20ad50966b810997eSergei Shtylyov	 * and we need to fully handle it in sh_eth_error() in order to quench
15003893b27345ac0ff13c1b9ec20ad50966b810997eSergei Shtylyov	 * it as it doesn't get cleared by just writing 1 to the ECI bit...
15013893b27345ac0ff13c1b9ec20ad50966b810997eSergei Shtylyov	 */
15023719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	intr_enable = sh_eth_read(ndev, EESIPR);
15033719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	intr_status &= intr_enable | DMAC_M_ECI;
15043719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	if (intr_status & (EESR_RX_CHECK | cd->tx_check | cd->eesr_err_check))
15050e0fde3c8d65524b8dfd834332d6e4a92711a66aNobuhiro Iwamatsu		ret = IRQ_HANDLED;
15063719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	else
15070e0fde3c8d65524b8dfd834332d6e4a92711a66aNobuhiro Iwamatsu		goto other_irq;
150886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
15093719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	if (intr_status & EESR_RX_CHECK) {
15103719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		if (napi_schedule_prep(&mdp->napi)) {
15113719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov			/* Mask Rx interrupts */
15123719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov			sh_eth_write(ndev, intr_enable & ~EESR_RX_CHECK,
15133719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov				     EESIPR);
15143719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov			__napi_schedule(&mdp->napi);
15153719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		} else {
15163719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov			dev_warn(&ndev->dev,
15173719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov				 "ignoring interrupt, status 0x%08lx, mask 0x%08lx.\n",
15183719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov				 intr_status, intr_enable);
15193719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		}
15203719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	}
152186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1522b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu	/* Tx Check */
1523380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (intr_status & cd->tx_check) {
15243719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		/* Clear Tx interrupts */
15253719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		sh_eth_write(ndev, intr_status & cd->tx_check, EESR);
15263719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov
152786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		sh_eth_txfree(ndev);
152886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		netif_wake_queue(ndev);
152986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
153086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
15313719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	if (intr_status & cd->eesr_err_check) {
15323719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		/* Clear error interrupts */
15333719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		sh_eth_write(ndev, intr_status & cd->eesr_err_check, EESR);
15343719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov
153586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		sh_eth_error(ndev, intr_status);
15363719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	}
153786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
15380e0fde3c8d65524b8dfd834332d6e4a92711a66aNobuhiro Iwamatsuother_irq:
153986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	spin_unlock(&mdp->lock);
154086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
15410e0fde3c8d65524b8dfd834332d6e4a92711a66aNobuhiro Iwamatsu	return ret;
154286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
154386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
15443719109d61ca96746c733538ec776d02a6952640Sergei Shtylyovstatic int sh_eth_poll(struct napi_struct *napi, int budget)
15453719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov{
15463719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	struct sh_eth_private *mdp = container_of(napi, struct sh_eth_private,
15473719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov						  napi);
15483719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	struct net_device *ndev = napi->dev;
15493719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	int quota = budget;
15503719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	unsigned long intr_status;
15513719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov
15523719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	for (;;) {
15533719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		intr_status = sh_eth_read(ndev, EESR);
15543719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		if (!(intr_status & EESR_RX_CHECK))
15553719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov			break;
15563719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		/* Clear Rx interrupts */
15573719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		sh_eth_write(ndev, intr_status & EESR_RX_CHECK, EESR);
15583719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov
15593719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		if (sh_eth_rx(ndev, intr_status, &quota))
15603719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov			goto out;
15613719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	}
15623719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov
15633719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	napi_complete(napi);
15643719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov
15653719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	/* Reenable Rx interrupts */
15663719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	sh_eth_write(ndev, mdp->cd->eesipr_value, EESIPR);
15673719109d61ca96746c733538ec776d02a6952640Sergei Shtylyovout:
15683719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	return budget - quota;
15693719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov}
15703719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov
157186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* PHY state control function */
157286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic void sh_eth_adjust_link(struct net_device *ndev)
157386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
157486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
157586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct phy_device *phydev = mdp->phydev;
157686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	int new_state = 0;
157786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
15783340d2aae3433ad9147f6bf0adc452b324e31591Sergei Shtylyov	if (phydev->link) {
157986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (phydev->duplex != mdp->duplex) {
158086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			new_state = 1;
158186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			mdp->duplex = phydev->duplex;
1582380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda			if (mdp->cd->set_duplex)
1583380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda				mdp->cd->set_duplex(ndev);
158486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		}
158586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
158686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (phydev->speed != mdp->speed) {
158786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			new_state = 1;
158886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			mdp->speed = phydev->speed;
1589380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda			if (mdp->cd->set_rate)
1590380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda				mdp->cd->set_rate(ndev);
159186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		}
15923340d2aae3433ad9147f6bf0adc452b324e31591Sergei Shtylyov		if (!mdp->link) {
159391a5615203355bb34e0b9e68e94f27f24719a74cYoshihiro Shimoda			sh_eth_write(ndev,
159491a5615203355bb34e0b9e68e94f27f24719a74cYoshihiro Shimoda				(sh_eth_read(ndev, ECMR) & ~ECMR_TXF), ECMR);
159586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			new_state = 1;
159686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			mdp->link = phydev->link;
15971e1b812bbe1069fc8e2e372dca7d5f541c7a8cebSergei Shtylyov			if (mdp->cd->no_psr || mdp->no_ether_link)
15981e1b812bbe1069fc8e2e372dca7d5f541c7a8cebSergei Shtylyov				sh_eth_rcv_snd_enable(ndev);
159986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		}
160086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	} else if (mdp->link) {
160186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		new_state = 1;
16023340d2aae3433ad9147f6bf0adc452b324e31591Sergei Shtylyov		mdp->link = 0;
160386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		mdp->speed = 0;
160486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		mdp->duplex = -1;
16051e1b812bbe1069fc8e2e372dca7d5f541c7a8cebSergei Shtylyov		if (mdp->cd->no_psr || mdp->no_ether_link)
16061e1b812bbe1069fc8e2e372dca7d5f541c7a8cebSergei Shtylyov			sh_eth_rcv_snd_disable(ndev);
160786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
160886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1609dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	if (new_state && netif_msg_link(mdp))
161086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		phy_print_status(phydev);
161186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
161286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
161386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* PHY init function */
161486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic int sh_eth_phy_init(struct net_device *ndev)
161586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
161686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
16170a372eb91f9d507701a901c2f62ed31ca67fd66cDavid S. Miller	char phy_id[MII_BUS_ID_SIZE + 3];
161886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct phy_device *phydev = NULL;
161986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1620fb28ad35906af2f042c94e2f9c0f898ef9acfa37Kay Sievers	snprintf(phy_id, sizeof(phy_id), PHY_ID_FMT,
162186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		mdp->mii_bus->id , mdp->phy_id);
162286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
16233340d2aae3433ad9147f6bf0adc452b324e31591Sergei Shtylyov	mdp->link = 0;
162486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp->speed = 0;
162586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp->duplex = -1;
162686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
162786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Try connect to PHY */
1628c061b18df0f1fe3f50fe451dbbdc9ede3c19701aJoe Perches	phydev = phy_connect(ndev, phy_id, sh_eth_adjust_link,
1629f9a8f83b04e0c362a2fc660dbad980d24af209fcFlorian Fainelli			     mdp->phy_interface);
163086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (IS_ERR(phydev)) {
163186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		dev_err(&ndev->dev, "phy_connect failed\n");
163286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		return PTR_ERR(phydev);
163386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
1634380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
163586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	dev_info(&ndev->dev, "attached phy %i to driver %s\n",
1636380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		phydev->addr, phydev->drv->name);
163786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
163886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp->phydev = phydev;
163986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
164086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return 0;
164186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
164286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
164386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* PHY control start function */
164486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic int sh_eth_phy_start(struct net_device *ndev)
164586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
164686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
164786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	int ret;
164886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
164986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	ret = sh_eth_phy_init(ndev);
165086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (ret)
165186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		return ret;
165286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
165386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* reset phy - this also wakes it from PDOWN */
165486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	phy_write(mdp->phydev, MII_BMCR, BMCR_RESET);
165586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	phy_start(mdp->phydev);
165686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
165786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return 0;
165886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
165986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1660dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsustatic int sh_eth_get_settings(struct net_device *ndev,
1661dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu			struct ethtool_cmd *ecmd)
1662dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu{
1663dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
1664dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	unsigned long flags;
1665dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	int ret;
1666dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1667dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	spin_lock_irqsave(&mdp->lock, flags);
1668dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	ret = phy_ethtool_gset(mdp->phydev, ecmd);
1669dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	spin_unlock_irqrestore(&mdp->lock, flags);
1670dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1671dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	return ret;
1672dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu}
1673dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1674dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsustatic int sh_eth_set_settings(struct net_device *ndev,
1675dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		struct ethtool_cmd *ecmd)
1676dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu{
1677dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
1678dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	unsigned long flags;
1679dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	int ret;
1680dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1681dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	spin_lock_irqsave(&mdp->lock, flags);
1682dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1683dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	/* disable tx and rx */
16844a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_rcv_snd_disable(ndev);
1685dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1686dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	ret = phy_ethtool_sset(mdp->phydev, ecmd);
1687dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	if (ret)
1688dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		goto error_exit;
1689dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1690dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	if (ecmd->duplex == DUPLEX_FULL)
1691dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		mdp->duplex = 1;
1692dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	else
1693dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		mdp->duplex = 0;
1694dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1695dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	if (mdp->cd->set_duplex)
1696dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		mdp->cd->set_duplex(ndev);
1697dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1698dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsuerror_exit:
1699dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	mdelay(1);
1700dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1701dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	/* enable tx and rx */
17024a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_rcv_snd_enable(ndev);
1703dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1704dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	spin_unlock_irqrestore(&mdp->lock, flags);
1705dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1706dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	return ret;
1707dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu}
1708dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1709dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsustatic int sh_eth_nway_reset(struct net_device *ndev)
1710dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu{
1711dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
1712dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	unsigned long flags;
1713dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	int ret;
1714dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1715dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	spin_lock_irqsave(&mdp->lock, flags);
1716dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	ret = phy_start_aneg(mdp->phydev);
1717dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	spin_unlock_irqrestore(&mdp->lock, flags);
1718dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1719dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	return ret;
1720dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu}
1721dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1722dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsustatic u32 sh_eth_get_msglevel(struct net_device *ndev)
1723dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu{
1724dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
1725dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	return mdp->msg_enable;
1726dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu}
1727dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1728dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsustatic void sh_eth_set_msglevel(struct net_device *ndev, u32 value)
1729dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu{
1730dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
1731dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	mdp->msg_enable = value;
1732dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu}
1733dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1734dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsustatic const char sh_eth_gstrings_stats[][ETH_GSTRING_LEN] = {
1735dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	"rx_current", "tx_current",
1736dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	"rx_dirty", "tx_dirty",
1737dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu};
1738dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu#define SH_ETH_STATS_LEN  ARRAY_SIZE(sh_eth_gstrings_stats)
1739dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1740dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsustatic int sh_eth_get_sset_count(struct net_device *netdev, int sset)
1741dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu{
1742dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	switch (sset) {
1743dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	case ETH_SS_STATS:
1744dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		return SH_ETH_STATS_LEN;
1745dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	default:
1746dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		return -EOPNOTSUPP;
1747dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	}
1748dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu}
1749dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1750dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsustatic void sh_eth_get_ethtool_stats(struct net_device *ndev,
1751dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu			struct ethtool_stats *stats, u64 *data)
1752dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu{
1753dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
1754dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	int i = 0;
1755dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1756dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	/* device-specific stats */
1757dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	data[i++] = mdp->cur_rx;
1758dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	data[i++] = mdp->cur_tx;
1759dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	data[i++] = mdp->dirty_rx;
1760dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	data[i++] = mdp->dirty_tx;
1761dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu}
1762dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1763dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsustatic void sh_eth_get_strings(struct net_device *ndev, u32 stringset, u8 *data)
1764dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu{
1765dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	switch (stringset) {
1766dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	case ETH_SS_STATS:
1767dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		memcpy(data, *sh_eth_gstrings_stats,
1768dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu					sizeof(sh_eth_gstrings_stats));
1769dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		break;
1770dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	}
1771dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu}
1772dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
1773525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimodastatic void sh_eth_get_ringparam(struct net_device *ndev,
1774525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda				 struct ethtool_ringparam *ring)
1775525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda{
1776525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
1777525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda
1778525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	ring->rx_max_pending = RX_RING_MAX;
1779525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	ring->tx_max_pending = TX_RING_MAX;
1780525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	ring->rx_pending = mdp->num_rx_ring;
1781525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	ring->tx_pending = mdp->num_tx_ring;
1782525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda}
1783525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda
1784525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimodastatic int sh_eth_set_ringparam(struct net_device *ndev,
1785525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda				struct ethtool_ringparam *ring)
1786525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda{
1787525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
1788525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	int ret;
1789525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda
1790525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	if (ring->tx_pending > TX_RING_MAX ||
1791525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	    ring->rx_pending > RX_RING_MAX ||
1792525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	    ring->tx_pending < TX_RING_MIN ||
1793525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	    ring->rx_pending < RX_RING_MIN)
1794525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		return -EINVAL;
1795525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	if (ring->rx_mini_pending || ring->rx_jumbo_pending)
1796525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		return -EINVAL;
1797525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda
1798525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	if (netif_running(ndev)) {
1799525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		netif_tx_disable(ndev);
1800525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		/* Disable interrupts by clearing the interrupt mask. */
1801525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		sh_eth_write(ndev, 0x0000, EESIPR);
1802525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		/* Stop the chip's Tx and Rx processes. */
1803525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		sh_eth_write(ndev, 0, EDTRR);
1804525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		sh_eth_write(ndev, 0, EDRRR);
1805525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		synchronize_irq(ndev->irq);
1806525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	}
1807525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda
1808525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	/* Free all the skbuffs in the Rx queue. */
1809525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	sh_eth_ring_free(ndev);
1810525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	/* Free DMA buffer */
1811525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	sh_eth_free_dma_buffer(mdp);
1812525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda
1813525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	/* Set new parameters */
1814525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	mdp->num_rx_ring = ring->rx_pending;
1815525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	mdp->num_tx_ring = ring->tx_pending;
1816525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda
1817525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	ret = sh_eth_ring_init(ndev);
1818525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	if (ret < 0) {
1819525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		dev_err(&ndev->dev, "%s: sh_eth_ring_init failed.\n", __func__);
1820525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		return ret;
1821525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	}
1822525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	ret = sh_eth_dev_init(ndev, false);
1823525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	if (ret < 0) {
1824525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		dev_err(&ndev->dev, "%s: sh_eth_dev_init failed.\n", __func__);
1825525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		return ret;
1826525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	}
1827525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda
1828525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	if (netif_running(ndev)) {
1829525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		sh_eth_write(ndev, mdp->cd->eesipr_value, EESIPR);
1830525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		/* Setting the Rx mode will start the Rx process. */
1831525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		sh_eth_write(ndev, EDRRR_R, EDRRR);
1832525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda		netif_wake_queue(ndev);
1833525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	}
1834525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda
1835525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	return 0;
1836525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda}
1837525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda
18389b07be4b2a78166bc54c8eedf18da8a8aafacfabstephen hemmingerstatic const struct ethtool_ops sh_eth_ethtool_ops = {
1839dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	.get_settings	= sh_eth_get_settings,
1840dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	.set_settings	= sh_eth_set_settings,
18419b07be4b2a78166bc54c8eedf18da8a8aafacfabstephen hemminger	.nway_reset	= sh_eth_nway_reset,
1842dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	.get_msglevel	= sh_eth_get_msglevel,
1843dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	.set_msglevel	= sh_eth_set_msglevel,
18449b07be4b2a78166bc54c8eedf18da8a8aafacfabstephen hemminger	.get_link	= ethtool_op_get_link,
1845dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	.get_strings	= sh_eth_get_strings,
1846dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	.get_ethtool_stats  = sh_eth_get_ethtool_stats,
1847dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	.get_sset_count     = sh_eth_get_sset_count,
1848525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	.get_ringparam	= sh_eth_get_ringparam,
1849525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	.set_ringparam	= sh_eth_set_ringparam,
1850dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu};
1851dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu
185286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* network device open function */
185386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic int sh_eth_open(struct net_device *ndev)
185486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
185586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	int ret = 0;
185686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
185786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1858bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	pm_runtime_get_sync(&mdp->pdev->dev);
1859bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm
1860a0607fd3a25ba1848a63a0d925e36d914735ab47Joe Perches	ret = request_irq(ndev->irq, sh_eth_interrupt,
18615b3dfd13ae8bdebea67c02612fe282baff850bb0Nobuhiro Iwamatsu			  mdp->cd->irq_flags, ndev->name, ndev);
186286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (ret) {
1863380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		dev_err(&ndev->dev, "Can not assign IRQ number\n");
186486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		return ret;
186586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
186686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
186786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Descriptor set */
186886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	ret = sh_eth_ring_init(ndev);
186986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (ret)
187086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		goto out_free_irq;
187186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
187286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* device init */
1873525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	ret = sh_eth_dev_init(ndev, true);
187486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (ret)
187586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		goto out_free_irq;
187686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
187786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* PHY control start*/
187886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	ret = sh_eth_phy_start(ndev);
187986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (ret)
188086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		goto out_free_irq;
188186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
18823719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	napi_enable(&mdp->napi);
18833719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov
188486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return ret;
188586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
188686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsuout_free_irq:
188786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	free_irq(ndev->irq, ndev);
1888bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	pm_runtime_put_sync(&mdp->pdev->dev);
188986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return ret;
189086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
189186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
189286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* Timeout function */
189386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic void sh_eth_tx_timeout(struct net_device *ndev)
189486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
189586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
189686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_rxdesc *rxdesc;
189786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	int i;
189886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
189986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	netif_stop_queue(ndev);
190086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1901dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	if (netif_msg_timer(mdp))
1902dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu		dev_err(&ndev->dev, "%s: transmit timed out, status %8.8x,"
19034a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	       " resetting...\n", ndev->name, (int)sh_eth_read(ndev, EESR));
190486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
190586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* tx_errors count up */
1906bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet	ndev->stats.tx_errors++;
190786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
190886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Free all the skbuffs in the Rx queue. */
1909525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	for (i = 0; i < mdp->num_rx_ring; i++) {
191086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		rxdesc = &mdp->rx_ring[i];
191186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		rxdesc->status = 0;
191286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		rxdesc->addr = 0xBADF00D0;
191386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (mdp->rx_skbuff[i])
191486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			dev_kfree_skb(mdp->rx_skbuff[i]);
191586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		mdp->rx_skbuff[i] = NULL;
191686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
1917525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	for (i = 0; i < mdp->num_tx_ring; i++) {
191886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (mdp->tx_skbuff[i])
191986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			dev_kfree_skb(mdp->tx_skbuff[i]);
192086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		mdp->tx_skbuff[i] = NULL;
192186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
192286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
192386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* device init */
1924525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	sh_eth_dev_init(ndev, true);
192586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
192686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
192786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* Packet transmit function */
192886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic int sh_eth_start_xmit(struct sk_buff *skb, struct net_device *ndev)
192986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
193086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
193186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_txdesc *txdesc;
193286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	u32 entry;
1933fb5e2f9b9410a4362897d12dc1ed4f7cec1b0d45Nobuhiro Iwamatsu	unsigned long flags;
193486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
193586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	spin_lock_irqsave(&mdp->lock, flags);
1936525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	if ((mdp->cur_tx - mdp->dirty_tx) >= (mdp->num_tx_ring - 4)) {
193786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		if (!sh_eth_txfree(ndev)) {
1938dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu			if (netif_msg_tx_queued(mdp))
1939dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu				dev_warn(&ndev->dev, "TxFD exhausted.\n");
194086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			netif_stop_queue(ndev);
194186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu			spin_unlock_irqrestore(&mdp->lock, flags);
19425b548140225c6bbbbd560551dd1048b2c0ce58bePatrick McHardy			return NETDEV_TX_BUSY;
194386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		}
194486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
194586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	spin_unlock_irqrestore(&mdp->lock, flags);
194686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1947525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	entry = mdp->cur_tx % mdp->num_tx_ring;
194886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp->tx_skbuff[entry] = skb;
194986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	txdesc = &mdp->tx_ring[entry];
195086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* soft swap. */
1951380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	if (!mdp->cd->hw_swap)
1952380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		sh_eth_soft_swap(phys_to_virt(ALIGN(txdesc->addr, 4)),
1953380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda				 skb->len + 2);
195431fcb99d9958bdf04e84224e202f69e6cdac893bYoshihiro Shimoda	txdesc->addr = dma_map_single(&ndev->dev, skb->data, skb->len,
195531fcb99d9958bdf04e84224e202f69e6cdac893bYoshihiro Shimoda				      DMA_TO_DEVICE);
195686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (skb->len < ETHERSMALL)
195786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		txdesc->buffer_length = ETHERSMALL;
195886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	else
195986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		txdesc->buffer_length = skb->len;
196086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1961525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	if (entry >= mdp->num_tx_ring - 1)
196271557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato		txdesc->status |= cpu_to_edmac(mdp, TD_TACT | TD_TDLE);
196386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	else
196471557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato		txdesc->status |= cpu_to_edmac(mdp, TD_TACT);
196586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
196686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp->cur_tx++;
196786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
1968c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda	if (!(sh_eth_read(ndev, EDTRR) & sh_eth_get_edtrr_trns(mdp)))
1969c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda		sh_eth_write(ndev, sh_eth_get_edtrr_trns(mdp), EDTRR);
1970b0ca2a21f769ae255bd6821cbc5af8af797f1da7Nobuhiro Iwamatsu
19716ed106549d17474ca17a16057f4c0ed4eba5a7caPatrick McHardy	return NETDEV_TX_OK;
197286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
197386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
197486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* device close function */
197586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic int sh_eth_close(struct net_device *ndev)
197686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
197786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
197886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
19793719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	napi_disable(&mdp->napi);
19803719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov
198186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	netif_stop_queue(ndev);
198286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
198386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Disable interrupts by clearing the interrupt mask. */
19844a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, 0x0000, EESIPR);
198586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
198686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Stop the chip's Tx and Rx processes. */
19874a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, 0, EDTRR);
19884a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, 0, EDRRR);
198986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
199086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* PHY Disconnect */
199186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (mdp->phydev) {
199286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		phy_stop(mdp->phydev);
199386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		phy_disconnect(mdp->phydev);
199486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
199586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
199686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	free_irq(ndev->irq, ndev);
199786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
199886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Free all the skbuffs in the Rx queue. */
199986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	sh_eth_ring_free(ndev);
200086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
200186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* free DMA buffer */
200291c77550000a7d888aaf9f9ac13e3e3485d18560Yoshihiro Shimoda	sh_eth_free_dma_buffer(mdp);
200386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
2004bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	pm_runtime_put_sync(&mdp->pdev->dev);
2005bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm
200686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return 0;
200786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
200886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
200986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic struct net_device_stats *sh_eth_get_stats(struct net_device *ndev)
201086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
201186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
201286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
2013bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	pm_runtime_get_sync(&mdp->pdev->dev);
2014bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm
2015bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet	ndev->stats.tx_dropped += sh_eth_read(ndev, TROCR);
20164a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, 0, TROCR);	/* (write clear) */
2017bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet	ndev->stats.collisions += sh_eth_read(ndev, CDCR);
20184a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, 0, CDCR);	/* (write clear) */
2019bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet	ndev->stats.tx_carrier_errors += sh_eth_read(ndev, LCCR);
20204a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_write(ndev, 0, LCCR);	/* (write clear) */
2021c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda	if (sh_eth_is_gether(mdp)) {
2022bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet		ndev->stats.tx_carrier_errors += sh_eth_read(ndev, CERCR);
2023c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda		sh_eth_write(ndev, 0, CERCR);	/* (write clear) */
2024bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet		ndev->stats.tx_carrier_errors += sh_eth_read(ndev, CEECR);
2025c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda		sh_eth_write(ndev, 0, CEECR);	/* (write clear) */
2026c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda	} else {
2027bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet		ndev->stats.tx_carrier_errors += sh_eth_read(ndev, CNDCR);
2028c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda		sh_eth_write(ndev, 0, CNDCR);	/* (write clear) */
2029c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda	}
2030bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	pm_runtime_put_sync(&mdp->pdev->dev);
2031bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm
2032bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet	return &ndev->stats;
203386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
203486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
2035bb7d92e3e3049e22b5807ac559a72b38fad5f499Eric Dumazet/* ioctl to device function */
203686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic int sh_eth_do_ioctl(struct net_device *ndev, struct ifreq *rq,
203786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu				int cmd)
203886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
203986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
204086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct phy_device *phydev = mdp->phydev;
204186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
204286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (!netif_running(ndev))
204386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		return -EINVAL;
204486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
204586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (!phydev)
204686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		return -ENODEV;
204786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
204828b041139e344ecd0f144d6205b004ae354cfa1eRichard Cochran	return phy_mii_ioctl(phydev, rq, cmd);
204986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
205086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
20516743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda/* For TSU_POSTn. Please refer to the manual about this (strange) bitfields */
20526743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic void *sh_eth_tsu_get_post_reg_offset(struct sh_eth_private *mdp,
20536743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda					    int entry)
20546743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
20556743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	return sh_eth_tsu_get_offset(mdp, TSU_POST1) + (entry / 8 * 4);
20566743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
20576743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
20586743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic u32 sh_eth_tsu_get_post_mask(int entry)
20596743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
20606743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	return 0x0f << (28 - ((entry % 8) * 4));
20616743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
20626743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
20636743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic u32 sh_eth_tsu_get_post_bit(struct sh_eth_private *mdp, int entry)
20646743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
20656743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	return (0x08 >> (mdp->port << 1)) << (28 - ((entry % 8) * 4));
20666743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
20676743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
20686743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic void sh_eth_tsu_enable_cam_entry_post(struct net_device *ndev,
20696743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda					     int entry)
20706743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
20716743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
20726743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	u32 tmp;
20736743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	void *reg_offset;
20746743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
20756743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	reg_offset = sh_eth_tsu_get_post_reg_offset(mdp, entry);
20766743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	tmp = ioread32(reg_offset);
20776743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	iowrite32(tmp | sh_eth_tsu_get_post_bit(mdp, entry), reg_offset);
20786743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
20796743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
20806743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic bool sh_eth_tsu_disable_cam_entry_post(struct net_device *ndev,
20816743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda					      int entry)
20826743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
20836743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
20846743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	u32 post_mask, ref_mask, tmp;
20856743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	void *reg_offset;
20866743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
20876743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	reg_offset = sh_eth_tsu_get_post_reg_offset(mdp, entry);
20886743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	post_mask = sh_eth_tsu_get_post_mask(entry);
20896743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	ref_mask = sh_eth_tsu_get_post_bit(mdp, entry) & ~post_mask;
20906743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
20916743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	tmp = ioread32(reg_offset);
20926743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	iowrite32(tmp & ~post_mask, reg_offset);
20936743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
20946743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	/* If other port enables, the function returns "true" */
20956743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	return tmp & ref_mask;
20966743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
20976743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
20986743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic int sh_eth_tsu_busy(struct net_device *ndev)
20996743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
21006743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	int timeout = SH_ETH_TSU_TIMEOUT_MS * 100;
21016743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
21026743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21036743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	while ((sh_eth_tsu_read(mdp, TSU_ADSBSY) & TSU_ADSBSY_0)) {
21046743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		udelay(10);
21056743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		timeout--;
21066743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		if (timeout <= 0) {
21076743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			dev_err(&ndev->dev, "%s: timeout\n", __func__);
21086743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			return -ETIMEDOUT;
21096743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		}
21106743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	}
21116743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21126743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	return 0;
21136743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
21146743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21156743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic int sh_eth_tsu_write_entry(struct net_device *ndev, void *reg,
21166743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda				  const u8 *addr)
21176743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
21186743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	u32 val;
21196743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21206743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	val = addr[0] << 24 | addr[1] << 16 | addr[2] << 8 | addr[3];
21216743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	iowrite32(val, reg);
21226743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	if (sh_eth_tsu_busy(ndev) < 0)
21236743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		return -EBUSY;
21246743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21256743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	val = addr[4] << 8 | addr[5];
21266743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	iowrite32(val, reg + 4);
21276743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	if (sh_eth_tsu_busy(ndev) < 0)
21286743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		return -EBUSY;
21296743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21306743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	return 0;
21316743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
21326743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21336743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic void sh_eth_tsu_read_entry(void *reg, u8 *addr)
21346743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
21356743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	u32 val;
21366743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21376743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	val = ioread32(reg);
21386743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	addr[0] = (val >> 24) & 0xff;
21396743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	addr[1] = (val >> 16) & 0xff;
21406743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	addr[2] = (val >> 8) & 0xff;
21416743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	addr[3] = val & 0xff;
21426743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	val = ioread32(reg + 4);
21436743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	addr[4] = (val >> 8) & 0xff;
21446743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	addr[5] = val & 0xff;
21456743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
21466743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21476743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21486743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic int sh_eth_tsu_find_entry(struct net_device *ndev, const u8 *addr)
21496743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
21506743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
21516743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	void *reg_offset = sh_eth_tsu_get_offset(mdp, TSU_ADRH0);
21526743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	int i;
21536743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	u8 c_addr[ETH_ALEN];
21546743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21556743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	for (i = 0; i < SH_ETH_TSU_CAM_ENTRIES; i++, reg_offset += 8) {
21566743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		sh_eth_tsu_read_entry(reg_offset, c_addr);
21576743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		if (memcmp(addr, c_addr, ETH_ALEN) == 0)
21586743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			return i;
21596743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	}
21606743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21616743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	return -ENOENT;
21626743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
21636743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21646743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic int sh_eth_tsu_find_empty(struct net_device *ndev)
21656743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
21666743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	u8 blank[ETH_ALEN];
21676743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	int entry;
21686743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21696743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	memset(blank, 0, sizeof(blank));
21706743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	entry = sh_eth_tsu_find_entry(ndev, blank);
21716743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	return (entry < 0) ? -ENOMEM : entry;
21726743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
21736743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21746743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic int sh_eth_tsu_disable_cam_entry_table(struct net_device *ndev,
21756743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda					      int entry)
21766743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
21776743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
21786743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	void *reg_offset = sh_eth_tsu_get_offset(mdp, TSU_ADRH0);
21796743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	int ret;
21806743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	u8 blank[ETH_ALEN];
21816743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21826743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	sh_eth_tsu_write(mdp, sh_eth_tsu_read(mdp, TSU_TEN) &
21836743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			 ~(1 << (31 - entry)), TSU_TEN);
21846743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21856743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	memset(blank, 0, sizeof(blank));
21866743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	ret = sh_eth_tsu_write_entry(ndev, reg_offset + entry * 8, blank);
21876743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	if (ret < 0)
21886743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		return ret;
21896743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	return 0;
21906743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
21916743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21926743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic int sh_eth_tsu_add_entry(struct net_device *ndev, const u8 *addr)
21936743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
21946743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
21956743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	void *reg_offset = sh_eth_tsu_get_offset(mdp, TSU_ADRH0);
21966743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	int i, ret;
21976743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
21986743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	if (!mdp->cd->tsu)
21996743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		return 0;
22006743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22016743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	i = sh_eth_tsu_find_entry(ndev, addr);
22026743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	if (i < 0) {
22036743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		/* No entry found, create one */
22046743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		i = sh_eth_tsu_find_empty(ndev);
22056743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		if (i < 0)
22066743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			return -ENOMEM;
22076743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		ret = sh_eth_tsu_write_entry(ndev, reg_offset + i * 8, addr);
22086743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		if (ret < 0)
22096743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			return ret;
22106743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22116743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		/* Enable the entry */
22126743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		sh_eth_tsu_write(mdp, sh_eth_tsu_read(mdp, TSU_TEN) |
22136743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda				 (1 << (31 - i)), TSU_TEN);
22146743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	}
22156743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22166743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	/* Entry found or created, enable POST */
22176743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	sh_eth_tsu_enable_cam_entry_post(ndev, i);
22186743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22196743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	return 0;
22206743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
22216743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22226743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic int sh_eth_tsu_del_entry(struct net_device *ndev, const u8 *addr)
22236743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
22246743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
22256743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	int i, ret;
22266743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22276743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	if (!mdp->cd->tsu)
22286743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		return 0;
22296743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22306743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	i = sh_eth_tsu_find_entry(ndev, addr);
22316743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	if (i) {
22326743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		/* Entry found */
22336743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		if (sh_eth_tsu_disable_cam_entry_post(ndev, i))
22346743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			goto done;
22356743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22366743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		/* Disable the entry if both ports was disabled */
22376743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		ret = sh_eth_tsu_disable_cam_entry_table(ndev, i);
22386743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		if (ret < 0)
22396743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			return ret;
22406743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	}
22416743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodadone:
22426743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	return 0;
22436743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
22446743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22456743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic int sh_eth_tsu_purge_all(struct net_device *ndev)
22466743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
22476743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
22486743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	int i, ret;
22496743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22506743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	if (unlikely(!mdp->cd->tsu))
22516743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		return 0;
22526743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22536743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	for (i = 0; i < SH_ETH_TSU_CAM_ENTRIES; i++) {
22546743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		if (sh_eth_tsu_disable_cam_entry_post(ndev, i))
22556743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			continue;
22566743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22576743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		/* Disable the entry if both ports was disabled */
22586743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		ret = sh_eth_tsu_disable_cam_entry_table(ndev, i);
22596743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		if (ret < 0)
22606743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			return ret;
22616743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	}
22626743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22636743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	return 0;
22646743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
22656743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22666743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimodastatic void sh_eth_tsu_purge_mcast(struct net_device *ndev)
22676743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda{
22686743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
22696743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	u8 addr[ETH_ALEN];
22706743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	void *reg_offset = sh_eth_tsu_get_offset(mdp, TSU_ADRH0);
22716743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	int i;
22726743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22736743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	if (unlikely(!mdp->cd->tsu))
22746743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		return;
22756743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22766743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	for (i = 0; i < SH_ETH_TSU_CAM_ENTRIES; i++, reg_offset += 8) {
22776743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		sh_eth_tsu_read_entry(reg_offset, addr);
22786743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		if (is_multicast_ether_addr(addr))
22796743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			sh_eth_tsu_del_entry(ndev, addr);
22806743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	}
22816743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda}
22826743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
228386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* Multicast reception directions set */
228486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic void sh_eth_set_multicast_list(struct net_device *ndev)
228586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
22866743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
22876743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	u32 ecmr_bits;
22886743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	int mcast_all = 0;
22896743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	unsigned long flags;
22906743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22916743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	spin_lock_irqsave(&mdp->lock, flags);
22926743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	/*
22936743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	 * Initial condition is MCT = 1, PRM = 0.
22946743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	 * Depending on ndev->flags, set PRM or clear MCT
22956743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	 */
22966743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	ecmr_bits = (sh_eth_read(ndev, ECMR) & ~ECMR_PRM) | ECMR_MCT;
22976743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
22986743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	if (!(ndev->flags & IFF_MULTICAST)) {
22996743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		sh_eth_tsu_purge_mcast(ndev);
23006743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		mcast_all = 1;
23016743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	}
23026743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	if (ndev->flags & IFF_ALLMULTI) {
23036743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		sh_eth_tsu_purge_mcast(ndev);
23046743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		ecmr_bits &= ~ECMR_MCT;
23056743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		mcast_all = 1;
23066743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	}
23076743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
230886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (ndev->flags & IFF_PROMISC) {
23096743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		sh_eth_tsu_purge_all(ndev);
23106743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		ecmr_bits = (ecmr_bits & ~ECMR_MCT) | ECMR_PRM;
23116743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	} else if (mdp->cd->tsu) {
23126743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		struct netdev_hw_addr *ha;
23136743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		netdev_for_each_mc_addr(ha, ndev) {
23146743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			if (mcast_all && is_multicast_ether_addr(ha->addr))
23156743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda				continue;
23166743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
23176743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			if (sh_eth_tsu_add_entry(ndev, ha->addr) < 0) {
23186743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda				if (!mcast_all) {
23196743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda					sh_eth_tsu_purge_mcast(ndev);
23206743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda					ecmr_bits &= ~ECMR_MCT;
23216743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda					mcast_all = 1;
23226743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda				}
23236743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda			}
23246743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		}
232586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	} else {
232686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		/* Normal, unicast/broadcast-only mode. */
23276743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		ecmr_bits = (ecmr_bits & ~ECMR_PRM) | ECMR_MCT;
232886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
23296743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
23306743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	/* update the ethernet mode */
23316743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	sh_eth_write(ndev, ecmr_bits, ECMR);
23326743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda
23336743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda	spin_unlock_irqrestore(&mdp->lock, flags);
233486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
233571cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda
233671cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimodastatic int sh_eth_get_vtag_index(struct sh_eth_private *mdp)
233771cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda{
233871cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	if (!mdp->port)
233971cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda		return TSU_VTAG0;
234071cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	else
234171cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda		return TSU_VTAG1;
234271cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda}
234371cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda
234480d5c3689b886308247da295a228a54df49a44f6Patrick McHardystatic int sh_eth_vlan_rx_add_vid(struct net_device *ndev,
234580d5c3689b886308247da295a228a54df49a44f6Patrick McHardy				  __be16 proto, u16 vid)
234671cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda{
234771cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
234871cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	int vtag_reg_index = sh_eth_get_vtag_index(mdp);
234971cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda
235071cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	if (unlikely(!mdp->cd->tsu))
235171cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda		return -EPERM;
235271cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda
235371cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	/* No filtering if vid = 0 */
235471cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	if (!vid)
235571cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda		return 0;
235671cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda
235771cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	mdp->vlan_num_ids++;
235871cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda
235971cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	/*
236071cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	 * The controller has one VLAN tag HW filter. So, if the filter is
236171cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	 * already enabled, the driver disables it and the filte
236271cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	 */
236371cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	if (mdp->vlan_num_ids > 1) {
236471cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda		/* disable VLAN filter */
236571cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda		sh_eth_tsu_write(mdp, 0, vtag_reg_index);
236671cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda		return 0;
236771cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	}
236871cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda
236971cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	sh_eth_tsu_write(mdp, TSU_VTAG_ENABLE | (vid & TSU_VTAG_VID_MASK),
237071cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda			 vtag_reg_index);
237171cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda
237271cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	return 0;
237371cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda}
237471cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda
237580d5c3689b886308247da295a228a54df49a44f6Patrick McHardystatic int sh_eth_vlan_rx_kill_vid(struct net_device *ndev,
237680d5c3689b886308247da295a228a54df49a44f6Patrick McHardy				   __be16 proto, u16 vid)
237771cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda{
237871cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	struct sh_eth_private *mdp = netdev_priv(ndev);
237971cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	int vtag_reg_index = sh_eth_get_vtag_index(mdp);
238071cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda
238171cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	if (unlikely(!mdp->cd->tsu))
238271cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda		return -EPERM;
238371cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda
238471cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	/* No filtering if vid = 0 */
238571cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	if (!vid)
238671cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda		return 0;
238771cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda
238871cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	mdp->vlan_num_ids--;
238971cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, vtag_reg_index);
239071cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda
239171cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda	return 0;
239271cc7c37af71b497698f7f8a68e46a458071fcefYoshihiro Shimoda}
239386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
239486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* SuperH's TSU register init function */
23954a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimodastatic void sh_eth_tsu_init(struct sh_eth_private *mdp)
239686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
23974a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_FWEN0);	/* Disable forward(0->1) */
23984a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_FWEN1);	/* Disable forward(1->0) */
23994a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_FCM);	/* forward fifo 3k-3k */
24004a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0xc, TSU_BSYSL0);
24014a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0xc, TSU_BSYSL1);
24024a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_PRISL0);
24034a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_PRISL1);
24044a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_FWSL0);
24054a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_FWSL1);
24064a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, TSU_FWSLC_POSTENU | TSU_FWSLC_POSTENL, TSU_FWSLC);
2407c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda	if (sh_eth_is_gether(mdp)) {
2408c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda		sh_eth_tsu_write(mdp, 0, TSU_QTAG0);	/* Disable QTAG(0->1) */
2409c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda		sh_eth_tsu_write(mdp, 0, TSU_QTAG1);	/* Disable QTAG(1->0) */
2410c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda	} else {
2411c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda		sh_eth_tsu_write(mdp, 0, TSU_QTAGM0);	/* Disable QTAG(0->1) */
2412c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda		sh_eth_tsu_write(mdp, 0, TSU_QTAGM1);	/* Disable QTAG(1->0) */
2413c5ed53687b39c195b4730de8c0355c1b78054ba6Yoshihiro Shimoda	}
24144a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_FWSR);	/* all interrupt status clear */
24154a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_FWINMK);	/* Disable all interrupt */
24164a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_TEN);	/* Disable all CAM entry */
24174a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_POST1);	/* Disable CAM entry [ 0- 7] */
24184a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_POST2);	/* Disable CAM entry [ 8-15] */
24194a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_POST3);	/* Disable CAM entry [16-23] */
24204a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	sh_eth_tsu_write(mdp, 0, TSU_POST4);	/* Disable CAM entry [24-31] */
242186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
242286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
242386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* MDIO bus release function */
242486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic int sh_mdio_release(struct net_device *ndev)
242586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
242686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct mii_bus *bus = dev_get_drvdata(&ndev->dev);
242786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
242886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* unregister mdio bus */
242986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdiobus_unregister(bus);
243086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
243186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* remove mdio bus info from net_device */
243286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	dev_set_drvdata(&ndev->dev, NULL);
243386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
243486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* free bitbang info */
243586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	free_mdio_bitbang(bus);
243686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
243786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return 0;
243886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
243986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
244086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu/* MDIO bus init function */
2441b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimodastatic int sh_mdio_init(struct net_device *ndev, int id,
2442b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda			struct sh_eth_plat_data *pd)
244386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
244486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	int ret, i;
244586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct bb_info *bitbang;
244686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct sh_eth_private *mdp = netdev_priv(ndev);
244786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
244886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* create bit control struct for PHY */
2449d5e07e69218fd9aa21d6c8c5ccc629d92bdb9b0fSergei Shtylyov	bitbang = devm_kzalloc(&ndev->dev, sizeof(struct bb_info),
2450d5e07e69218fd9aa21d6c8c5ccc629d92bdb9b0fSergei Shtylyov			       GFP_KERNEL);
245186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (!bitbang) {
245286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		ret = -ENOMEM;
245386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		goto out;
245486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
245586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
245686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* bitbang init */
2457ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda	bitbang->addr = mdp->addr + mdp->reg_offset[PIR];
2458b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda	bitbang->set_gate = pd->set_mdio_gate;
2459dfed5e7fb4ec946694cad7400d75c44f3bb7f645Sergei Shtylyov	bitbang->mdi_msk = PIR_MDI;
2460dfed5e7fb4ec946694cad7400d75c44f3bb7f645Sergei Shtylyov	bitbang->mdo_msk = PIR_MDO;
2461dfed5e7fb4ec946694cad7400d75c44f3bb7f645Sergei Shtylyov	bitbang->mmd_msk = PIR_MMD;
2462dfed5e7fb4ec946694cad7400d75c44f3bb7f645Sergei Shtylyov	bitbang->mdc_msk = PIR_MDC;
246386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	bitbang->ctrl.ops = &bb_ops;
246486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
2465c2e07b3a9ced33dd92597201be3931be8ea57ed6Stefan Weil	/* MII controller setting */
246686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp->mii_bus = alloc_mdio_bitbang(&bitbang->ctrl);
246786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (!mdp->mii_bus) {
246886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		ret = -ENOMEM;
2469d5e07e69218fd9aa21d6c8c5ccc629d92bdb9b0fSergei Shtylyov		goto out;
247086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
247186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
247286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Hook up MII support for ethtool */
247386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp->mii_bus->name = "sh_mii";
247418ee49ddb0d242ed1d0e273038d5e4f6de7379d3Lennert Buytenhek	mdp->mii_bus->parent = &ndev->dev;
24755278fb547076ad6768d16c8b4df45c086470c163Florian Fainelli	snprintf(mdp->mii_bus->id, MII_BUS_ID_SIZE, "%s-%x",
247634aa6f1400810890636ba0b170effbfa71eacec7Nobuhiro Iwamatsu		mdp->pdev->name, id);
247786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
247886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* PHY IRQ */
2479d5e07e69218fd9aa21d6c8c5ccc629d92bdb9b0fSergei Shtylyov	mdp->mii_bus->irq = devm_kzalloc(&ndev->dev,
2480d5e07e69218fd9aa21d6c8c5ccc629d92bdb9b0fSergei Shtylyov					 sizeof(int) * PHY_MAX_ADDR,
2481d5e07e69218fd9aa21d6c8c5ccc629d92bdb9b0fSergei Shtylyov					 GFP_KERNEL);
248286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (!mdp->mii_bus->irq) {
248386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		ret = -ENOMEM;
248486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		goto out_free_bus;
248586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
248686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
248786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	for (i = 0; i < PHY_MAX_ADDR; i++)
248886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		mdp->mii_bus->irq[i] = PHY_POLL;
248986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
24908f6352f2b5aecd4b0af5ef31361af1146f9528d6YOSHIFUJI Hideaki / 吉藤英明	/* register mdio bus */
249186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	ret = mdiobus_register(mdp->mii_bus);
249286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (ret)
2493d5e07e69218fd9aa21d6c8c5ccc629d92bdb9b0fSergei Shtylyov		goto out_free_bus;
249486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
249586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	dev_set_drvdata(&ndev->dev, mdp->mii_bus);
249686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
249786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return 0;
249886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
249986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsuout_free_bus:
2500298cf9beb9679522de995e249eccbd82f7c51999Lennert Buytenhek	free_mdio_bitbang(mdp->mii_bus);
250186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
250286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsuout:
250386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return ret;
250486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
250586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
25064a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimodastatic const u16 *sh_eth_get_register_offset(int register_type)
25074a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda{
25084a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	const u16 *reg_offset = NULL;
25094a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda
25104a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	switch (register_type) {
25114a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	case SH_ETH_REG_GIGABIT:
25124a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		reg_offset = sh_eth_offset_gigabit;
25134a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		break;
2514a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov	case SH_ETH_REG_FAST_RCAR:
2515a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov		reg_offset = sh_eth_offset_fast_rcar;
2516a3f109bd793dfe5c611220ca5ab6c72f1aed479eSergei Shtylyov		break;
25174a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	case SH_ETH_REG_FAST_SH4:
25184a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		reg_offset = sh_eth_offset_fast_sh4;
25194a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		break;
25204a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	case SH_ETH_REG_FAST_SH3_SH2:
25214a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		reg_offset = sh_eth_offset_fast_sh3_sh2;
25224a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		break;
25234a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	default:
252414c3326a111b948cabc35d523a43a1e6663f6091Nobuhiro Iwamatsu		pr_err("Unknown register type (%d)\n", register_type);
25254a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda		break;
25264a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	}
25274a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda
25284a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	return reg_offset;
25294a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda}
25304a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda
25318f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyovstatic const struct net_device_ops sh_eth_netdev_ops = {
2532ebf84eaa927be41a440fd4c8f81e1844922bc0b2Alexander Beregalov	.ndo_open		= sh_eth_open,
2533ebf84eaa927be41a440fd4c8f81e1844922bc0b2Alexander Beregalov	.ndo_stop		= sh_eth_close,
2534ebf84eaa927be41a440fd4c8f81e1844922bc0b2Alexander Beregalov	.ndo_start_xmit		= sh_eth_start_xmit,
2535ebf84eaa927be41a440fd4c8f81e1844922bc0b2Alexander Beregalov	.ndo_get_stats		= sh_eth_get_stats,
2536ebf84eaa927be41a440fd4c8f81e1844922bc0b2Alexander Beregalov	.ndo_tx_timeout		= sh_eth_tx_timeout,
2537ebf84eaa927be41a440fd4c8f81e1844922bc0b2Alexander Beregalov	.ndo_do_ioctl		= sh_eth_do_ioctl,
2538ebf84eaa927be41a440fd4c8f81e1844922bc0b2Alexander Beregalov	.ndo_validate_addr	= eth_validate_addr,
2539ebf84eaa927be41a440fd4c8f81e1844922bc0b2Alexander Beregalov	.ndo_set_mac_address	= eth_mac_addr,
2540ebf84eaa927be41a440fd4c8f81e1844922bc0b2Alexander Beregalov	.ndo_change_mtu		= eth_change_mtu,
2541ebf84eaa927be41a440fd4c8f81e1844922bc0b2Alexander Beregalov};
2542ebf84eaa927be41a440fd4c8f81e1844922bc0b2Alexander Beregalov
25438f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyovstatic const struct net_device_ops sh_eth_netdev_ops_tsu = {
25448f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	.ndo_open		= sh_eth_open,
25458f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	.ndo_stop		= sh_eth_close,
25468f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	.ndo_start_xmit		= sh_eth_start_xmit,
25478f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	.ndo_get_stats		= sh_eth_get_stats,
25488f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	.ndo_set_rx_mode	= sh_eth_set_multicast_list,
25498f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	.ndo_vlan_rx_add_vid	= sh_eth_vlan_rx_add_vid,
25508f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	.ndo_vlan_rx_kill_vid	= sh_eth_vlan_rx_kill_vid,
25518f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	.ndo_tx_timeout		= sh_eth_tx_timeout,
25528f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	.ndo_do_ioctl		= sh_eth_do_ioctl,
25538f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	.ndo_validate_addr	= eth_validate_addr,
25548f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	.ndo_set_mac_address	= eth_mac_addr,
25558f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	.ndo_change_mtu		= eth_change_mtu,
25568f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov};
25578f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov
255886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic int sh_eth_drv_probe(struct platform_device *pdev)
255986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
25609c38657cfcb739b7dc4ce9065a85b4f0c195bef8Kuninori Morimoto	int ret, devno = 0;
256186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct resource *res;
256286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct net_device *ndev = NULL;
2563ec0d75518cb06261f1823fa2713fe52b9b26455eKuninori Morimoto	struct sh_eth_private *mdp = NULL;
2564564044b0928d46a87774c246ae80cb3cead9264dSergei Shtylyov	struct sh_eth_plat_data *pd = pdev->dev.platform_data;
2565afe391ad4b05f8f00ca955e165f3b37b480506b7Sergei Shtylyov	const struct platform_device_id *id = platform_get_device_id(pdev);
256686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
256786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* get base addr */
256886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
256986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (unlikely(res == NULL)) {
257086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		dev_err(&pdev->dev, "invalid resource\n");
257186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		ret = -EINVAL;
257286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		goto out;
257386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
257486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
257586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	ndev = alloc_etherdev(sizeof(struct sh_eth_private));
257686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (!ndev) {
257786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		ret = -ENOMEM;
257886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		goto out;
257986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
258086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
258186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* The sh Ether-specific entries in the device structure. */
258286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	ndev->base_addr = res->start;
258386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	devno = pdev->id;
258486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (devno < 0)
258586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		devno = 0;
258686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
258786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	ndev->dma = -1;
2588cc3c080d9f4484021e7b14f99de94a8c85a668d5roel kluin	ret = platform_get_irq(pdev, 0);
2589cc3c080d9f4484021e7b14f99de94a8c85a668d5roel kluin	if (ret < 0) {
259086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		ret = -ENODEV;
259186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		goto out_release;
259286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
2593cc3c080d9f4484021e7b14f99de94a8c85a668d5roel kluin	ndev->irq = ret;
259486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
259586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	SET_NETDEV_DEV(ndev, &pdev->dev);
259686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
259786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* Fill in the fields of the device structure with ethernet values. */
259886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	ether_setup(ndev);
259986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
260086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	mdp = netdev_priv(ndev);
2601525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	mdp->num_tx_ring = TX_RING_SIZE;
2602525b8075edda9c2ab4b81e210505bd7487ea6e56Yoshihiro Shimoda	mdp->num_rx_ring = RX_RING_SIZE;
2603d5e07e69218fd9aa21d6c8c5ccc629d92bdb9b0fSergei Shtylyov	mdp->addr = devm_ioremap_resource(&pdev->dev, res);
2604d5e07e69218fd9aa21d6c8c5ccc629d92bdb9b0fSergei Shtylyov	if (IS_ERR(mdp->addr)) {
2605d5e07e69218fd9aa21d6c8c5ccc629d92bdb9b0fSergei Shtylyov		ret = PTR_ERR(mdp->addr);
2606ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda		goto out_release;
2607ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda	}
2608ae70644df780c0e87f1705fda932e7cb1bdb2074Yoshihiro Shimoda
260986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	spin_lock_init(&mdp->lock);
2610bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	mdp->pdev = pdev;
2611bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	pm_runtime_enable(&pdev->dev);
2612bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	pm_runtime_resume(&pdev->dev);
261386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
261486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* get PHY ID */
261571557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	mdp->phy_id = pd->phy;
2616e47c90523484518aac30498150e427d824ace705Yoshihiro Shimoda	mdp->phy_interface = pd->phy_interface;
261771557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	/* EDMAC endian */
261871557a37adb5df17631c493b3b7d912938c720b2Yoshinori Sato	mdp->edmac_endian = pd->edmac_endian;
26194923576b8ac5bfd36ab2beb176aeb747aaab7e41Yoshihiro Shimoda	mdp->no_ether_link = pd->no_ether_link;
26204923576b8ac5bfd36ab2beb176aeb747aaab7e41Yoshihiro Shimoda	mdp->ether_link_active_low = pd->ether_link_active_low;
26214a55530f38e4eeee3afb06093e81309138fe8360Yoshihiro Shimoda	mdp->reg_offset = sh_eth_get_register_offset(pd->register_type);
262286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
2623380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	/* set cpu data */
2624589ebdef7e3107401bf96a9c660753d397329ee9Sergei Shtylyov	mdp->cd = (struct sh_eth_cpu_data *)id->driver_data;
2625380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda	sh_eth_set_default_cpu_data(mdp->cd);
2626380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda
262786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* set function */
26288f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	if (mdp->cd->tsu)
26298f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov		ndev->netdev_ops = &sh_eth_netdev_ops_tsu;
26308f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov	else
26318f728d7934c77f63e89abcc96b46a7a98416d5c1Sergei Shtylyov		ndev->netdev_ops = &sh_eth_netdev_ops;
2632dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	SET_ETHTOOL_OPS(ndev, &sh_eth_ethtool_ops);
263386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	ndev->watchdog_timeo = TX_TIMEOUT;
263486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
2635dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	/* debug message level */
2636dc19e4e5e02fb6b46cccb08b2735e38b997a6ddfNobuhiro Iwamatsu	mdp->msg_enable = SH_ETH_DEF_MSG_ENABLE;
263786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
263886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* read and set MAC address */
2639748031f9fd2c06b28817d80761a5de97190cfd03Magnus Damm	read_mac_address(ndev, pd->mac_addr);
2640ff6e722870ddca2808b5d46159e58904f8ededf1Sergei Shtylyov	if (!is_valid_ether_addr(ndev->dev_addr)) {
2641ff6e722870ddca2808b5d46159e58904f8ededf1Sergei Shtylyov		dev_warn(&pdev->dev,
2642ff6e722870ddca2808b5d46159e58904f8ededf1Sergei Shtylyov			 "no valid MAC address supplied, using a random one.\n");
2643ff6e722870ddca2808b5d46159e58904f8ededf1Sergei Shtylyov		eth_hw_addr_random(ndev);
2644ff6e722870ddca2808b5d46159e58904f8ededf1Sergei Shtylyov	}
264586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
26466ba88021c36516c26c11eff8c6d7d9a045faecd3Yoshihiro Shimoda	/* ioremap the TSU registers */
26476ba88021c36516c26c11eff8c6d7d9a045faecd3Yoshihiro Shimoda	if (mdp->cd->tsu) {
26486ba88021c36516c26c11eff8c6d7d9a045faecd3Yoshihiro Shimoda		struct resource *rtsu;
26496ba88021c36516c26c11eff8c6d7d9a045faecd3Yoshihiro Shimoda		rtsu = platform_get_resource(pdev, IORESOURCE_MEM, 1);
2650d5e07e69218fd9aa21d6c8c5ccc629d92bdb9b0fSergei Shtylyov		mdp->tsu_addr = devm_ioremap_resource(&pdev->dev, rtsu);
2651d5e07e69218fd9aa21d6c8c5ccc629d92bdb9b0fSergei Shtylyov		if (IS_ERR(mdp->tsu_addr)) {
2652d5e07e69218fd9aa21d6c8c5ccc629d92bdb9b0fSergei Shtylyov			ret = PTR_ERR(mdp->tsu_addr);
2653fc0c0900408e05758a0df17c1924ca837fafca5eSergei Shtylyov			goto out_release;
2654fc0c0900408e05758a0df17c1924ca837fafca5eSergei Shtylyov		}
26556743fe6df43b4dc5950f605edfeee086d0a80f06Yoshihiro Shimoda		mdp->port = devno % 2;
2656f646968f8f7c624587de729115d802372b9063ddPatrick McHardy		ndev->features = NETIF_F_HW_VLAN_CTAG_FILTER;
26576ba88021c36516c26c11eff8c6d7d9a045faecd3Yoshihiro Shimoda	}
26586ba88021c36516c26c11eff8c6d7d9a045faecd3Yoshihiro Shimoda
2659150647fb2c313d7c5184fca3fa0829a4a7d6f7bcYoshihiro Shimoda	/* initialize first or needed device */
2660150647fb2c313d7c5184fca3fa0829a4a7d6f7bcYoshihiro Shimoda	if (!devno || pd->needs_init) {
2661380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda		if (mdp->cd->chip_reset)
2662380af9e390ec81e74a2fd7fad948a8b12eeec7daYoshihiro Shimoda			mdp->cd->chip_reset(ndev);
266386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
26644986b996882d82c68ab54b822d7cfdd7dd35f19aYoshihiro Shimoda		if (mdp->cd->tsu) {
26654986b996882d82c68ab54b822d7cfdd7dd35f19aYoshihiro Shimoda			/* TSU init (Init only)*/
26664986b996882d82c68ab54b822d7cfdd7dd35f19aYoshihiro Shimoda			sh_eth_tsu_init(mdp);
26674986b996882d82c68ab54b822d7cfdd7dd35f19aYoshihiro Shimoda		}
266886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	}
266986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
26703719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	netif_napi_add(ndev, &mdp->napi, sh_eth_poll, 64);
26713719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov
267286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* network device register */
267386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	ret = register_netdev(ndev);
267486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (ret)
26753719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov		goto out_napi_del;
267686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
267786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* mdio bus init */
2678b3017e6a03d261778ad9450b5510460c4d462203Yoshihiro Shimoda	ret = sh_mdio_init(ndev, pdev->id, pd);
267986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (ret)
268086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		goto out_unregister;
268186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
268225985edcedea6396277003854657b5f3cb31a628Lucas De Marchi	/* print device information */
26836cd9b49d7328c4656bfc17fcb47fb814955d40d2H Hartley Sweeten	pr_info("Base address at 0x%x, %pM, IRQ %d.\n",
26846cd9b49d7328c4656bfc17fcb47fb814955d40d2H Hartley Sweeten	       (u32)ndev->base_addr, ndev->dev_addr, ndev->irq);
268586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
268686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	platform_set_drvdata(pdev, ndev);
268786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
268886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return ret;
268986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
269086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsuout_unregister:
269186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	unregister_netdev(ndev);
269286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
26933719109d61ca96746c733538ec776d02a6952640Sergei Shtylyovout_napi_del:
26943719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	netif_napi_del(&mdp->napi);
26953719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov
269686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsuout_release:
269786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	/* net_dev free */
269886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	if (ndev)
269986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		free_netdev(ndev);
270086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
270186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsuout:
270286a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return ret;
270386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
270486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
270586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic int sh_eth_drv_remove(struct platform_device *pdev)
270686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu{
270786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	struct net_device *ndev = platform_get_drvdata(pdev);
27083719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	struct sh_eth_private *mdp = netdev_priv(ndev);
270986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
271086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	sh_mdio_release(ndev);
271186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	unregister_netdev(ndev);
27123719109d61ca96746c733538ec776d02a6952640Sergei Shtylyov	netif_napi_del(&mdp->napi);
2713bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	pm_runtime_disable(&pdev->dev);
271486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	free_netdev(ndev);
271586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
271686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	return 0;
271786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu}
271886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
2719540ad1b888ad9564520c1c8c48ad675f76ffce62Nobuhiro Iwamatsu#ifdef CONFIG_PM
2720bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Dammstatic int sh_eth_runtime_nop(struct device *dev)
2721bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm{
2722bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	/*
2723bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	 * Runtime PM callback shared between ->runtime_suspend()
2724bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	 * and ->runtime_resume(). Simply returns success.
2725bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	 *
2726bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	 * This driver re-initializes all registers after
2727bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	 * pm_runtime_get_sync() anyway so there is no need
2728bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	 * to save and restore registers here.
2729bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	 */
2730bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	return 0;
2731bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm}
2732bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm
2733540ad1b888ad9564520c1c8c48ad675f76ffce62Nobuhiro Iwamatsustatic const struct dev_pm_ops sh_eth_dev_pm_ops = {
2734bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	.runtime_suspend = sh_eth_runtime_nop,
2735bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm	.runtime_resume = sh_eth_runtime_nop,
2736bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm};
2737540ad1b888ad9564520c1c8c48ad675f76ffce62Nobuhiro Iwamatsu#define SH_ETH_PM_OPS (&sh_eth_dev_pm_ops)
2738540ad1b888ad9564520c1c8c48ad675f76ffce62Nobuhiro Iwamatsu#else
2739540ad1b888ad9564520c1c8c48ad675f76ffce62Nobuhiro Iwamatsu#define SH_ETH_PM_OPS NULL
2740540ad1b888ad9564520c1c8c48ad675f76ffce62Nobuhiro Iwamatsu#endif
2741bcd5149ded6b2edbf3732fa1483600a716b1cba6Magnus Damm
2742afe391ad4b05f8f00ca955e165f3b37b480506b7Sergei Shtylyovstatic struct platform_device_id sh_eth_id_table[] = {
2743c18a79abe31f555ec3b363b5b8c1d003230053b6Sergei Shtylyov	{ "sh7619-ether", (kernel_ulong_t)&sh7619_data },
27447bbe150d8c57c59689c8c50fd7b9915f4a7e10daSergei Shtylyov	{ "sh771x-ether", (kernel_ulong_t)&sh771x_data },
27459c3beaabb951d672b1534c7f56f84054b088f879Sergei Shtylyov	{ "sh7724-ether", (kernel_ulong_t)&sh7724_data },
2746f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	{ "sh7734-gether", (kernel_ulong_t)&sh7734_data },
274724549e2a0f33628b5160eac16c6aebf1cfaf22f1Sergei Shtylyov	{ "sh7757-ether", (kernel_ulong_t)&sh7757_data },
274824549e2a0f33628b5160eac16c6aebf1cfaf22f1Sergei Shtylyov	{ "sh7757-gether", (kernel_ulong_t)&sh7757_data_giga },
2749f5d12767c8fd77e29d3d6771de59fd9ac3e540bbSergei Shtylyov	{ "sh7763-gether", (kernel_ulong_t)&sh7763_data },
2750e5c9b4cd665106d9b5397114ea81a53059410b6aSergei Shtylyov	{ "r8a7740-gether", (kernel_ulong_t)&r8a7740_data },
2751589ebdef7e3107401bf96a9c660753d397329ee9Sergei Shtylyov	{ "r8a777x-ether", (kernel_ulong_t)&r8a777x_data },
2752afe391ad4b05f8f00ca955e165f3b37b480506b7Sergei Shtylyov	{ }
2753afe391ad4b05f8f00ca955e165f3b37b480506b7Sergei Shtylyov};
2754afe391ad4b05f8f00ca955e165f3b37b480506b7Sergei ShtylyovMODULE_DEVICE_TABLE(platform, sh_eth_id_table);
2755afe391ad4b05f8f00ca955e165f3b37b480506b7Sergei Shtylyov
275686a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsustatic struct platform_driver sh_eth_driver = {
275786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	.probe = sh_eth_drv_probe,
275886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	.remove = sh_eth_drv_remove,
2759afe391ad4b05f8f00ca955e165f3b37b480506b7Sergei Shtylyov	.id_table = sh_eth_id_table,
276086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	.driver = {
276186a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu		   .name = CARDNAME,
2762540ad1b888ad9564520c1c8c48ad675f76ffce62Nobuhiro Iwamatsu		   .pm = SH_ETH_PM_OPS,
276386a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu	},
276486a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu};
276586a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
2766db62f684deeb291ab2533b99843d5df9a36b1f19Axel Linmodule_platform_driver(sh_eth_driver);
276786a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro Iwamatsu
276886a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro IwamatsuMODULE_AUTHOR("Nobuhiro Iwamatsu, Yoshihiro Shimoda");
276986a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro IwamatsuMODULE_DESCRIPTION("Renesas SuperH Ethernet driver");
277086a74ff21a7ac4bc06b18076ddb0347712b46cfdNobuhiro IwamatsuMODULE_LICENSE("GPL v2");
2771