Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / drivers / net / phy / spi_ks8995.c
1 /*
2  * SPI driver for Micrel/Kendin KS8995M and KSZ8864RMN ethernet switches
3  *
4  * Copyright (C) 2008 Gabor Juhos <juhosg at openwrt.org>
5  *
6  * This file was based on: drivers/spi/at25.c
7  *     Copyright (C) 2006 David Brownell
8  *
9  * This program is free software; you can redistribute it and/or modify it
10  * under the terms of the GNU General Public License version 2 as published
11  * by the Free Software Foundation.
12  */
13
14 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
15
16 #include <linux/types.h>
17 #include <linux/kernel.h>
18 #include <linux/module.h>
19 #include <linux/delay.h>
20 #include <linux/device.h>
21
22 #include <linux/spi/spi.h>
23
24 #define DRV_VERSION             "0.1.1"
25 #define DRV_DESC                "Micrel KS8995 Ethernet switch SPI driver"
26
27 /* ------------------------------------------------------------------------ */
28
29 #define KS8995_REG_ID0          0x00    /* Chip ID0 */
30 #define KS8995_REG_ID1          0x01    /* Chip ID1 */
31
32 #define KS8995_REG_GC0          0x02    /* Global Control 0 */
33 #define KS8995_REG_GC1          0x03    /* Global Control 1 */
34 #define KS8995_REG_GC2          0x04    /* Global Control 2 */
35 #define KS8995_REG_GC3          0x05    /* Global Control 3 */
36 #define KS8995_REG_GC4          0x06    /* Global Control 4 */
37 #define KS8995_REG_GC5          0x07    /* Global Control 5 */
38 #define KS8995_REG_GC6          0x08    /* Global Control 6 */
39 #define KS8995_REG_GC7          0x09    /* Global Control 7 */
40 #define KS8995_REG_GC8          0x0a    /* Global Control 8 */
41 #define KS8995_REG_GC9          0x0b    /* Global Control 9 */
42
43 #define KS8995_REG_PC(p, r)     ((0x10 * p) + r)         /* Port Control */
44 #define KS8995_REG_PS(p, r)     ((0x10 * p) + r + 0xe)  /* Port Status */
45
46 #define KS8995_REG_TPC0         0x60    /* TOS Priority Control 0 */
47 #define KS8995_REG_TPC1         0x61    /* TOS Priority Control 1 */
48 #define KS8995_REG_TPC2         0x62    /* TOS Priority Control 2 */
49 #define KS8995_REG_TPC3         0x63    /* TOS Priority Control 3 */
50 #define KS8995_REG_TPC4         0x64    /* TOS Priority Control 4 */
51 #define KS8995_REG_TPC5         0x65    /* TOS Priority Control 5 */
52 #define KS8995_REG_TPC6         0x66    /* TOS Priority Control 6 */
53 #define KS8995_REG_TPC7         0x67    /* TOS Priority Control 7 */
54
55 #define KS8995_REG_MAC0         0x68    /* MAC address 0 */
56 #define KS8995_REG_MAC1         0x69    /* MAC address 1 */
57 #define KS8995_REG_MAC2         0x6a    /* MAC address 2 */
58 #define KS8995_REG_MAC3         0x6b    /* MAC address 3 */
59 #define KS8995_REG_MAC4         0x6c    /* MAC address 4 */
60 #define KS8995_REG_MAC5         0x6d    /* MAC address 5 */
61
62 #define KS8995_REG_IAC0         0x6e    /* Indirect Access Control 0 */
63 #define KS8995_REG_IAC1         0x6f    /* Indirect Access Control 0 */
64 #define KS8995_REG_IAD7         0x70    /* Indirect Access Data 7 */
65 #define KS8995_REG_IAD6         0x71    /* Indirect Access Data 6 */
66 #define KS8995_REG_IAD5         0x72    /* Indirect Access Data 5 */
67 #define KS8995_REG_IAD4         0x73    /* Indirect Access Data 4 */
68 #define KS8995_REG_IAD3         0x74    /* Indirect Access Data 3 */
69 #define KS8995_REG_IAD2         0x75    /* Indirect Access Data 2 */
70 #define KS8995_REG_IAD1         0x76    /* Indirect Access Data 1 */
71 #define KS8995_REG_IAD0         0x77    /* Indirect Access Data 0 */
72
73 #define KSZ8864_REG_ID1         0xfe    /* Chip ID in bit 7 */
74
75 #define KS8995_REGS_SIZE        0x80
76 #define KSZ8864_REGS_SIZE       0x100
77
78 #define ID1_CHIPID_M            0xf
79 #define ID1_CHIPID_S            4
80 #define ID1_REVISION_M          0x7
81 #define ID1_REVISION_S          1
82 #define ID1_START_SW            1       /* start the switch */
83
84 #define FAMILY_KS8995           0x95
85 #define CHIPID_M                0
86
87 #define KS8995_CMD_WRITE        0x02U
88 #define KS8995_CMD_READ         0x03U
89
90 #define KS8995_RESET_DELAY      10 /* usec */
91
92 struct ks8995_pdata {
93         /* not yet implemented */
94 };
95
96 struct ks8995_switch {
97         struct spi_device       *spi;
98         struct mutex            lock;
99         struct ks8995_pdata     *pdata;
100         struct bin_attribute    regs_attr;
101 };
102
103 static inline u8 get_chip_id(u8 val)
104 {
105         return (val >> ID1_CHIPID_S) & ID1_CHIPID_M;
106 }
107
108 static inline u8 get_chip_rev(u8 val)
109 {
110         return (val >> ID1_REVISION_S) & ID1_REVISION_M;
111 }
112
113 /* ------------------------------------------------------------------------ */
114 static int ks8995_read(struct ks8995_switch *ks, char *buf,
115                  unsigned offset, size_t count)
116 {
117         u8 cmd[2];
118         struct spi_transfer t[2];
119         struct spi_message m;
120         int err;
121
122         spi_message_init(&m);
123
124         memset(&t, 0, sizeof(t));
125
126         t[0].tx_buf = cmd;
127         t[0].len = sizeof(cmd);
128         spi_message_add_tail(&t[0], &m);
129
130         t[1].rx_buf = buf;
131         t[1].len = count;
132         spi_message_add_tail(&t[1], &m);
133
134         cmd[0] = KS8995_CMD_READ;
135         cmd[1] = offset;
136
137         mutex_lock(&ks->lock);
138         err = spi_sync(ks->spi, &m);
139         mutex_unlock(&ks->lock);
140
141         return err ? err : count;
142 }
143
144
145 static int ks8995_write(struct ks8995_switch *ks, char *buf,
146                  unsigned offset, size_t count)
147 {
148         u8 cmd[2];
149         struct spi_transfer t[2];
150         struct spi_message m;
151         int err;
152
153         spi_message_init(&m);
154
155         memset(&t, 0, sizeof(t));
156
157         t[0].tx_buf = cmd;
158         t[0].len = sizeof(cmd);
159         spi_message_add_tail(&t[0], &m);
160
161         t[1].tx_buf = buf;
162         t[1].len = count;
163         spi_message_add_tail(&t[1], &m);
164
165         cmd[0] = KS8995_CMD_WRITE;
166         cmd[1] = offset;
167
168         mutex_lock(&ks->lock);
169         err = spi_sync(ks->spi, &m);
170         mutex_unlock(&ks->lock);
171
172         return err ? err : count;
173 }
174
175 static inline int ks8995_read_reg(struct ks8995_switch *ks, u8 addr, u8 *buf)
176 {
177         return ks8995_read(ks, buf, addr, 1) != 1;
178 }
179
180 static inline int ks8995_write_reg(struct ks8995_switch *ks, u8 addr, u8 val)
181 {
182         char buf = val;
183
184         return ks8995_write(ks, &buf, addr, 1) != 1;
185 }
186
187 /* ------------------------------------------------------------------------ */
188
189 static int ks8995_stop(struct ks8995_switch *ks)
190 {
191         return ks8995_write_reg(ks, KS8995_REG_ID1, 0);
192 }
193
194 static int ks8995_start(struct ks8995_switch *ks)
195 {
196         return ks8995_write_reg(ks, KS8995_REG_ID1, 1);
197 }
198
199 static int ks8995_reset(struct ks8995_switch *ks)
200 {
201         int err;
202
203         err = ks8995_stop(ks);
204         if (err)
205                 return err;
206
207         udelay(KS8995_RESET_DELAY);
208
209         return ks8995_start(ks);
210 }
211
212 /* ------------------------------------------------------------------------ */
213
214 static ssize_t ks8995_registers_read(struct file *filp, struct kobject *kobj,
215         struct bin_attribute *bin_attr, char *buf, loff_t off, size_t count)
216 {
217         struct device *dev;
218         struct ks8995_switch *ks8995;
219
220         dev = container_of(kobj, struct device, kobj);
221         ks8995 = dev_get_drvdata(dev);
222
223         if (unlikely(off > ks8995->regs_attr.size))
224                 return 0;
225
226         if ((off + count) > ks8995->regs_attr.size)
227                 count = ks8995->regs_attr.size - off;
228
229         if (unlikely(!count))
230                 return count;
231
232         return ks8995_read(ks8995, buf, off, count);
233 }
234
235
236 static ssize_t ks8995_registers_write(struct file *filp, struct kobject *kobj,
237         struct bin_attribute *bin_attr, char *buf, loff_t off, size_t count)
238 {
239         struct device *dev;
240         struct ks8995_switch *ks8995;
241
242         dev = container_of(kobj, struct device, kobj);
243         ks8995 = dev_get_drvdata(dev);
244
245         if (unlikely(off >= ks8995->regs_attr.size))
246                 return -EFBIG;
247
248         if ((off + count) > ks8995->regs_attr.size)
249                 count = ks8995->regs_attr.size - off;
250
251         if (unlikely(!count))
252                 return count;
253
254         return ks8995_write(ks8995, buf, off, count);
255 }
256
257
258 static const struct bin_attribute ks8995_registers_attr = {
259         .attr = {
260                 .name   = "registers",
261                 .mode   = S_IRUSR | S_IWUSR,
262         },
263         .size   = KS8995_REGS_SIZE,
264         .read   = ks8995_registers_read,
265         .write  = ks8995_registers_write,
266 };
267
268 /* ------------------------------------------------------------------------ */
269
270 static int ks8995_probe(struct spi_device *spi)
271 {
272         struct ks8995_switch    *ks;
273         struct ks8995_pdata     *pdata;
274         u8      ids[2];
275         int     err;
276
277         /* Chip description */
278         pdata = spi->dev.platform_data;
279
280         ks = devm_kzalloc(&spi->dev, sizeof(*ks), GFP_KERNEL);
281         if (!ks)
282                 return -ENOMEM;
283
284         mutex_init(&ks->lock);
285         ks->pdata = pdata;
286         ks->spi = spi_dev_get(spi);
287         spi_set_drvdata(spi, ks);
288
289         spi->mode = SPI_MODE_0;
290         spi->bits_per_word = 8;
291         err = spi_setup(spi);
292         if (err) {
293                 dev_err(&spi->dev, "spi_setup failed, err=%d\n", err);
294                 return err;
295         }
296
297         err = ks8995_read(ks, ids, KS8995_REG_ID0, sizeof(ids));
298         if (err < 0) {
299                 dev_err(&spi->dev, "unable to read id registers, err=%d\n",
300                                 err);
301                 return err;
302         }
303
304         switch (ids[0]) {
305         case FAMILY_KS8995:
306                 break;
307         default:
308                 dev_err(&spi->dev, "unknown family id:%02x\n", ids[0]);
309                 return -ENODEV;
310         }
311
312         memcpy(&ks->regs_attr, &ks8995_registers_attr, sizeof(ks->regs_attr));
313         if (get_chip_id(ids[1]) != CHIPID_M) {
314                 u8 val;
315
316                 /* Check if this is a KSZ8864RMN */
317                 err = ks8995_read(ks, &val, KSZ8864_REG_ID1, sizeof(val));
318                 if (err < 0) {
319                         dev_err(&spi->dev,
320                                 "unable to read chip id register, err=%d\n",
321                                 err);
322                         return err;
323                 }
324                 if ((val & 0x80) == 0) {
325                         dev_err(&spi->dev, "unknown chip:%02x,0\n", ids[1]);
326                         return err;
327                 }
328                 ks->regs_attr.size = KSZ8864_REGS_SIZE;
329         }
330
331         err = ks8995_reset(ks);
332         if (err)
333                 return err;
334
335         err = sysfs_create_bin_file(&spi->dev.kobj, &ks->regs_attr);
336         if (err) {
337                 dev_err(&spi->dev, "unable to create sysfs file, err=%d\n",
338                                     err);
339                 return err;
340         }
341
342         if (get_chip_id(ids[1]) == CHIPID_M) {
343                 dev_info(&spi->dev,
344                          "KS8995 device found, Chip ID:%x, Revision:%x\n",
345                          get_chip_id(ids[1]), get_chip_rev(ids[1]));
346         } else {
347                 dev_info(&spi->dev, "KSZ8864 device found, Revision:%x\n",
348                          get_chip_rev(ids[1]));
349         }
350
351         return 0;
352 }
353
354 static int ks8995_remove(struct spi_device *spi)
355 {
356         struct ks8995_switch *ks = spi_get_drvdata(spi);
357
358         sysfs_remove_bin_file(&spi->dev.kobj, &ks->regs_attr);
359
360         return 0;
361 }
362
363 /* ------------------------------------------------------------------------ */
364
365 static struct spi_driver ks8995_driver = {
366         .driver = {
367                 .name       = "spi-ks8995",
368                 .owner     = THIS_MODULE,
369         },
370         .probe    = ks8995_probe,
371         .remove   = ks8995_remove,
372 };
373
374 module_spi_driver(ks8995_driver);
375
376 MODULE_DESCRIPTION(DRV_DESC);
377 MODULE_VERSION(DRV_VERSION);
378 MODULE_AUTHOR("Gabor Juhos <juhosg at openwrt.org>");
379 MODULE_LICENSE("GPL v2");