Commit | Line | Data |
---|---|---|
1d3bb996 DG |
1 | /* |
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 | ||
21 | int __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 | ||
33 | void __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 | ||
42 | void tah_reset(struct of_device *ofdev) | |
43 | { | |
44 | struct tah_instance *dev = dev_get_drvdata(&ofdev->dev); | |
eb4d84f1 | 45 | struct tah_regs __iomem *p = dev->base; |
1d3bb996 DG |
46 | 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 | ||
63 | int tah_get_regs_len(struct of_device *ofdev) | |
64 | { | |
65 | return sizeof(struct emac_ethtool_regs_subhdr) + | |
66 | sizeof(struct tah_regs); | |
67 | } | |
68 | ||
69 | void *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 | ||
84 | static 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, ®s)) { | |
105 | printk(KERN_ERR "%s: Can't get registers address\n", | |
106 | np->full_name); | |
107 | goto err_free; | |
108 | } | |
109 | ||
110 | rc = -ENOMEM; | |
eb4d84f1 | 111 | dev->base = (struct tah_regs __iomem *)ioremap(regs.start, |
1d3bb996 DG |
112 | 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 | ||
119 | /* Initialize TAH and enable IPv4 checksum verification, no TSO yet */ | |
120 | tah_reset(ofdev); | |
121 | ||
122 | printk(KERN_INFO | |
123 | "TAH %s initialized\n", ofdev->node->full_name); | |
124 | wmb(); | |
125 | dev_set_drvdata(&ofdev->dev, dev); | |
126 | ||
127 | return 0; | |
128 | ||
129 | err_free: | |
130 | kfree(dev); | |
131 | err_gone: | |
132 | return rc; | |
133 | } | |
134 | ||
135 | static int __devexit tah_remove(struct of_device *ofdev) | |
136 | { | |
137 | struct tah_instance *dev = dev_get_drvdata(&ofdev->dev); | |
138 | ||
139 | dev_set_drvdata(&ofdev->dev, NULL); | |
140 | ||
141 | WARN_ON(dev->users != 0); | |
142 | ||
143 | iounmap(dev->base); | |
144 | kfree(dev); | |
145 | ||
146 | return 0; | |
147 | } | |
148 | ||
149 | static struct of_device_id tah_match[] = | |
150 | { | |
151 | { | |
152 | .type = "tah", | |
153 | }, | |
154 | {}, | |
155 | }; | |
156 | ||
157 | static struct of_platform_driver tah_driver = { | |
158 | .name = "emac-tah", | |
159 | .match_table = tah_match, | |
160 | ||
161 | .probe = tah_probe, | |
162 | .remove = tah_remove, | |
163 | }; | |
164 | ||
165 | int __init tah_init(void) | |
166 | { | |
167 | return of_register_platform_driver(&tah_driver); | |
168 | } | |
169 | ||
170 | void tah_exit(void) | |
171 | { | |
172 | of_unregister_platform_driver(&tah_driver); | |
173 | } |