blob: 6e35cbe15931c69038079452a886eb0a138359b0 [file] [log] [blame]
David Gibson1d3bb992007-08-23 13:56:01 +10001/*
2 * drivers/net/ibm_newemac/tah.c
3 *
4 * Driver for PowerPC 4xx on-chip ethernet controller, TAH support.
5 *
6 * Copyright 2004 MontaVista Software, Inc.
7 * Matt Porter <mporter@kernel.crashing.org>
8 *
9 * Copyright (c) 2005 Eugene Surovegin <ebs@ebshome.net>
10 *
11 * This program is free software; you can redistribute it and/or modify it
12 * under the terms of the GNU General Public License as published by the
13 * Free Software Foundation; either version 2 of the License, or (at your
14 * option) any later version.
15 */
16#include <asm/io.h>
17
18#include "emac.h"
19#include "core.h"
20
21int __devinit tah_attach(struct of_device *ofdev, int channel)
22{
23 struct tah_instance *dev = dev_get_drvdata(&ofdev->dev);
24
25 mutex_lock(&dev->lock);
26 /* Reset has been done at probe() time... nothing else to do for now */
27 ++dev->users;
28 mutex_unlock(&dev->lock);
29
30 return 0;
31}
32
33void __devexit tah_detach(struct of_device *ofdev, int channel)
34{
35 struct tah_instance *dev = dev_get_drvdata(&ofdev->dev);
36
37 mutex_lock(&dev->lock);
38 --dev->users;
39 mutex_unlock(&dev->lock);
40}
41
42void tah_reset(struct of_device *ofdev)
43{
44 struct tah_instance *dev = dev_get_drvdata(&ofdev->dev);
Al Viroeb4d84f2007-10-14 19:36:10 +010045 struct tah_regs __iomem *p = dev->base;
David Gibson1d3bb992007-08-23 13:56:01 +100046 int n;
47
48 /* Reset TAH */
49 out_be32(&p->mr, TAH_MR_SR);
50 n = 100;
51 while ((in_be32(&p->mr) & TAH_MR_SR) && n)
52 --n;
53
54 if (unlikely(!n))
55 printk(KERN_ERR "%s: reset timeout\n", ofdev->node->full_name);
56
57 /* 10KB TAH TX FIFO accomodates the max MTU of 9000 */
58 out_be32(&p->mr,
59 TAH_MR_CVR | TAH_MR_ST_768 | TAH_MR_TFS_10KB | TAH_MR_DTFP |
60 TAH_MR_DIG);
61}
62
63int tah_get_regs_len(struct of_device *ofdev)
64{
65 return sizeof(struct emac_ethtool_regs_subhdr) +
66 sizeof(struct tah_regs);
67}
68
69void *tah_dump_regs(struct of_device *ofdev, void *buf)
70{
71 struct tah_instance *dev = dev_get_drvdata(&ofdev->dev);
72 struct emac_ethtool_regs_subhdr *hdr = buf;
73 struct tah_regs *regs = (struct tah_regs *)(hdr + 1);
74
75 hdr->version = 0;
76 hdr->index = 0; /* for now, are there chips with more than one
77 * zmii ? if yes, then we'll add a cell_index
78 * like we do for emac
79 */
80 memcpy_fromio(regs, dev->base, sizeof(struct tah_regs));
81 return regs + 1;
82}
83
84static int __devinit tah_probe(struct of_device *ofdev,
85 const struct of_device_id *match)
86{
87 struct device_node *np = ofdev->node;
88 struct tah_instance *dev;
89 struct resource regs;
90 int rc;
91
92 rc = -ENOMEM;
93 dev = kzalloc(sizeof(struct tah_instance), GFP_KERNEL);
94 if (dev == NULL) {
95 printk(KERN_ERR "%s: could not allocate TAH device!\n",
96 np->full_name);
97 goto err_gone;
98 }
99
100 mutex_init(&dev->lock);
101 dev->ofdev = ofdev;
102
103 rc = -ENXIO;
104 if (of_address_to_resource(np, 0, &regs)) {
105 printk(KERN_ERR "%s: Can't get registers address\n",
106 np->full_name);
107 goto err_free;
108 }
109
110 rc = -ENOMEM;
Al Viroeb4d84f2007-10-14 19:36:10 +0100111 dev->base = (struct tah_regs __iomem *)ioremap(regs.start,
David Gibson1d3bb992007-08-23 13:56:01 +1000112 sizeof(struct tah_regs));
113 if (dev->base == NULL) {
114 printk(KERN_ERR "%s: Can't map device registers!\n",
115 np->full_name);
116 goto err_free;
117 }
118
Valentine Barshakd09e18b2007-12-05 11:14:32 +1100119 dev_set_drvdata(&ofdev->dev, dev);
120
David Gibson1d3bb992007-08-23 13:56:01 +1000121 /* Initialize TAH and enable IPv4 checksum verification, no TSO yet */
122 tah_reset(ofdev);
123
124 printk(KERN_INFO
125 "TAH %s initialized\n", ofdev->node->full_name);
126 wmb();
David Gibson1d3bb992007-08-23 13:56:01 +1000127
128 return 0;
129
130 err_free:
131 kfree(dev);
132 err_gone:
133 return rc;
134}
135
136static int __devexit tah_remove(struct of_device *ofdev)
137{
138 struct tah_instance *dev = dev_get_drvdata(&ofdev->dev);
139
140 dev_set_drvdata(&ofdev->dev, NULL);
141
142 WARN_ON(dev->users != 0);
143
144 iounmap(dev->base);
145 kfree(dev);
146
147 return 0;
148}
149
150static struct of_device_id tah_match[] =
151{
152 {
153 .type = "tah",
154 },
155 {},
156};
157
158static struct of_platform_driver tah_driver = {
159 .name = "emac-tah",
160 .match_table = tah_match,
161
162 .probe = tah_probe,
163 .remove = tah_remove,
164};
165
166int __init tah_init(void)
167{
168 return of_register_platform_driver(&tah_driver);
169}
170
171void tah_exit(void)
172{
173 of_unregister_platform_driver(&tah_driver);
174}