blob: 80e180f163f544e28e90f976146a090fad74da43 [file] [log] [blame]
Taku Izumi658d4392015-08-21 17:29:17 +09001/*
2 * FUJITSU Extended Socket Network Device driver
3 * Copyright (c) 2015 FUJITSU LIMITED
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms and conditions of the GNU General Public License,
7 * version 2, as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, see <http://www.gnu.org/licenses/>.
16 *
17 * The full GNU General Public License is included in this distribution in
18 * the file called "COPYING".
19 *
20 */
21
22#include <linux/module.h>
23#include <linux/types.h>
24#include <linux/nls.h>
25#include <linux/platform_device.h>
Taku Izumi2fcbca62015-08-21 17:29:20 +090026#include <linux/netdevice.h>
Taku Izumie5d486d2015-08-21 17:29:23 +090027#include <linux/interrupt.h>
Taku Izumi658d4392015-08-21 17:29:17 +090028
29#include "fjes.h"
30
31#define MAJ 1
32#define MIN 0
33#define DRV_VERSION __stringify(MAJ) "." __stringify(MIN)
34#define DRV_NAME "fjes"
35char fjes_driver_name[] = DRV_NAME;
36char fjes_driver_version[] = DRV_VERSION;
37static const char fjes_driver_string[] =
38 "FUJITSU Extended Socket Network Device Driver";
39static const char fjes_copyright[] =
40 "Copyright (c) 2015 FUJITSU LIMITED";
41
42MODULE_AUTHOR("Taku Izumi <izumi.taku@jp.fujitsu.com>");
43MODULE_DESCRIPTION("FUJITSU Extended Socket Network Device Driver");
44MODULE_LICENSE("GPL");
45MODULE_VERSION(DRV_VERSION);
46
Taku Izumie5d486d2015-08-21 17:29:23 +090047static int fjes_request_irq(struct fjes_adapter *);
48static void fjes_free_irq(struct fjes_adapter *);
49
50static int fjes_open(struct net_device *);
51static int fjes_close(struct net_device *);
52static int fjes_setup_resources(struct fjes_adapter *);
53static void fjes_free_resources(struct fjes_adapter *);
Taku Izumi9acf51c2015-08-21 17:29:24 +090054static netdev_tx_t fjes_xmit_frame(struct sk_buff *, struct net_device *);
Taku Izumib772b9d2015-08-21 17:29:25 +090055static void fjes_raise_intr_rxdata_task(struct work_struct *);
Taku Izumie5d486d2015-08-21 17:29:23 +090056static irqreturn_t fjes_intr(int, void*);
57
Taku Izumi658d4392015-08-21 17:29:17 +090058static int fjes_acpi_add(struct acpi_device *);
59static int fjes_acpi_remove(struct acpi_device *);
60static acpi_status fjes_get_acpi_resource(struct acpi_resource *, void*);
61
62static int fjes_probe(struct platform_device *);
63static int fjes_remove(struct platform_device *);
64
Taku Izumi2fcbca62015-08-21 17:29:20 +090065static int fjes_sw_init(struct fjes_adapter *);
66static void fjes_netdev_setup(struct net_device *);
67
Taku Izumi658d4392015-08-21 17:29:17 +090068static const struct acpi_device_id fjes_acpi_ids[] = {
69 {"PNP0C02", 0},
70 {"", 0},
71};
72MODULE_DEVICE_TABLE(acpi, fjes_acpi_ids);
73
74static struct acpi_driver fjes_acpi_driver = {
75 .name = DRV_NAME,
76 .class = DRV_NAME,
77 .owner = THIS_MODULE,
78 .ids = fjes_acpi_ids,
79 .ops = {
80 .add = fjes_acpi_add,
81 .remove = fjes_acpi_remove,
82 },
83};
84
85static struct platform_driver fjes_driver = {
86 .driver = {
87 .name = DRV_NAME,
88 .owner = THIS_MODULE,
89 },
90 .probe = fjes_probe,
91 .remove = fjes_remove,
92};
93
94static struct resource fjes_resource[] = {
95 {
96 .flags = IORESOURCE_MEM,
97 .start = 0,
98 .end = 0,
99 },
100 {
101 .flags = IORESOURCE_IRQ,
102 .start = 0,
103 .end = 0,
104 },
105};
106
107static int fjes_acpi_add(struct acpi_device *device)
108{
109 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL};
110 char str_buf[sizeof(FJES_ACPI_SYMBOL) + 1];
111 struct platform_device *plat_dev;
112 union acpi_object *str;
113 acpi_status status;
114 int result;
115
116 status = acpi_evaluate_object(device->handle, "_STR", NULL, &buffer);
117 if (ACPI_FAILURE(status))
118 return -ENODEV;
119
120 str = buffer.pointer;
121 result = utf16s_to_utf8s((wchar_t *)str->string.pointer,
122 str->string.length, UTF16_LITTLE_ENDIAN,
123 str_buf, sizeof(str_buf) - 1);
124 str_buf[result] = 0;
125
126 if (strncmp(FJES_ACPI_SYMBOL, str_buf, strlen(FJES_ACPI_SYMBOL)) != 0) {
127 kfree(buffer.pointer);
128 return -ENODEV;
129 }
130 kfree(buffer.pointer);
131
132 status = acpi_walk_resources(device->handle, METHOD_NAME__CRS,
133 fjes_get_acpi_resource, fjes_resource);
134 if (ACPI_FAILURE(status))
135 return -ENODEV;
136
137 /* create platform_device */
138 plat_dev = platform_device_register_simple(DRV_NAME, 0, fjes_resource,
139 ARRAY_SIZE(fjes_resource));
140 device->driver_data = plat_dev;
141
142 return 0;
143}
144
145static int fjes_acpi_remove(struct acpi_device *device)
146{
147 struct platform_device *plat_dev;
148
149 plat_dev = (struct platform_device *)acpi_driver_data(device);
150 platform_device_unregister(plat_dev);
151
152 return 0;
153}
154
155static acpi_status
156fjes_get_acpi_resource(struct acpi_resource *acpi_res, void *data)
157{
158 struct acpi_resource_address32 *addr;
159 struct acpi_resource_irq *irq;
160 struct resource *res = data;
161
162 switch (acpi_res->type) {
163 case ACPI_RESOURCE_TYPE_ADDRESS32:
164 addr = &acpi_res->data.address32;
165 res[0].start = addr->address.minimum;
166 res[0].end = addr->address.minimum +
167 addr->address.address_length - 1;
168 break;
169
170 case ACPI_RESOURCE_TYPE_IRQ:
171 irq = &acpi_res->data.irq;
172 if (irq->interrupt_count != 1)
173 return AE_ERROR;
174 res[1].start = irq->interrupts[0];
175 res[1].end = irq->interrupts[0];
176 break;
177
178 default:
179 break;
180 }
181
182 return AE_OK;
183}
184
Taku Izumie5d486d2015-08-21 17:29:23 +0900185static int fjes_request_irq(struct fjes_adapter *adapter)
186{
187 struct net_device *netdev = adapter->netdev;
188 int result = -1;
189
190 if (!adapter->irq_registered) {
191 result = request_irq(adapter->hw.hw_res.irq, fjes_intr,
192 IRQF_SHARED, netdev->name, adapter);
193 if (result)
194 adapter->irq_registered = false;
195 else
196 adapter->irq_registered = true;
197 }
198
199 return result;
200}
201
202static void fjes_free_irq(struct fjes_adapter *adapter)
203{
204 struct fjes_hw *hw = &adapter->hw;
205
206 fjes_hw_set_irqmask(hw, REG_ICTL_MASK_ALL, true);
207
208 if (adapter->irq_registered) {
209 free_irq(adapter->hw.hw_res.irq, adapter);
210 adapter->irq_registered = false;
211 }
212}
213
Taku Izumi2fcbca62015-08-21 17:29:20 +0900214static const struct net_device_ops fjes_netdev_ops = {
Taku Izumie5d486d2015-08-21 17:29:23 +0900215 .ndo_open = fjes_open,
216 .ndo_stop = fjes_close,
Taku Izumi9acf51c2015-08-21 17:29:24 +0900217 .ndo_start_xmit = fjes_xmit_frame,
Taku Izumi2fcbca62015-08-21 17:29:20 +0900218};
219
Taku Izumie5d486d2015-08-21 17:29:23 +0900220/* fjes_open - Called when a network interface is made active */
221static int fjes_open(struct net_device *netdev)
222{
223 struct fjes_adapter *adapter = netdev_priv(netdev);
224 struct fjes_hw *hw = &adapter->hw;
225 int result;
226
227 if (adapter->open_guard)
228 return -ENXIO;
229
230 result = fjes_setup_resources(adapter);
231 if (result)
232 goto err_setup_res;
233
234 hw->txrx_stop_req_bit = 0;
235 hw->epstop_req_bit = 0;
236
237 fjes_hw_capture_interrupt_status(hw);
238
239 result = fjes_request_irq(adapter);
240 if (result)
241 goto err_req_irq;
242
243 fjes_hw_set_irqmask(hw, REG_ICTL_MASK_ALL, false);
244
245 netif_tx_start_all_queues(netdev);
246 netif_carrier_on(netdev);
247
248 return 0;
249
250err_req_irq:
251 fjes_free_irq(adapter);
252
253err_setup_res:
254 fjes_free_resources(adapter);
255 return result;
256}
257
258/* fjes_close - Disables a network interface */
259static int fjes_close(struct net_device *netdev)
260{
261 struct fjes_adapter *adapter = netdev_priv(netdev);
262 struct fjes_hw *hw = &adapter->hw;
263 int epidx;
264
265 netif_tx_stop_all_queues(netdev);
266 netif_carrier_off(netdev);
267
268 fjes_hw_raise_epstop(hw);
269
270 for (epidx = 0; epidx < hw->max_epid; epidx++) {
271 if (epidx == hw->my_epid)
272 continue;
273
274 adapter->hw.ep_shm_info[epidx].tx.info->v1i.rx_status &=
275 ~FJES_RX_POLL_WORK;
276 }
277
278 fjes_free_irq(adapter);
279
Taku Izumib772b9d2015-08-21 17:29:25 +0900280 cancel_work_sync(&adapter->raise_intr_rxdata_task);
281
Taku Izumie5d486d2015-08-21 17:29:23 +0900282 fjes_hw_wait_epstop(hw);
283
284 fjes_free_resources(adapter);
285
286 return 0;
287}
288
289static int fjes_setup_resources(struct fjes_adapter *adapter)
290{
291 struct net_device *netdev = adapter->netdev;
292 struct ep_share_mem_info *buf_pair;
293 struct fjes_hw *hw = &adapter->hw;
294 int result;
295 int epidx;
296
297 mutex_lock(&hw->hw_info.lock);
298 result = fjes_hw_request_info(hw);
299 switch (result) {
300 case 0:
301 for (epidx = 0; epidx < hw->max_epid; epidx++) {
302 hw->ep_shm_info[epidx].es_status =
303 hw->hw_info.res_buf->info.info[epidx].es_status;
304 hw->ep_shm_info[epidx].zone =
305 hw->hw_info.res_buf->info.info[epidx].zone;
306 }
307 break;
308 default:
309 case -ENOMSG:
310 case -EBUSY:
311 adapter->force_reset = true;
312
313 mutex_unlock(&hw->hw_info.lock);
314 return result;
315 }
316 mutex_unlock(&hw->hw_info.lock);
317
318 for (epidx = 0; epidx < (hw->max_epid); epidx++) {
319 if ((epidx != hw->my_epid) &&
320 (hw->ep_shm_info[epidx].es_status ==
321 FJES_ZONING_STATUS_ENABLE)) {
322 fjes_hw_raise_interrupt(hw, epidx,
323 REG_ICTL_MASK_INFO_UPDATE);
324 }
325 }
326
327 msleep(FJES_OPEN_ZONE_UPDATE_WAIT * hw->max_epid);
328
329 for (epidx = 0; epidx < (hw->max_epid); epidx++) {
330 if (epidx == hw->my_epid)
331 continue;
332
333 buf_pair = &hw->ep_shm_info[epidx];
334
335 fjes_hw_setup_epbuf(&buf_pair->tx, netdev->dev_addr,
336 netdev->mtu);
337
338 if (fjes_hw_epid_is_same_zone(hw, epidx)) {
339 mutex_lock(&hw->hw_info.lock);
340 result =
341 fjes_hw_register_buff_addr(hw, epidx, buf_pair);
342 mutex_unlock(&hw->hw_info.lock);
343
344 switch (result) {
345 case 0:
346 break;
347 case -ENOMSG:
348 case -EBUSY:
349 default:
350 adapter->force_reset = true;
351 return result;
352 }
353 }
354 }
355
356 return 0;
357}
358
359static void fjes_free_resources(struct fjes_adapter *adapter)
360{
361 struct net_device *netdev = adapter->netdev;
362 struct fjes_device_command_param param;
363 struct ep_share_mem_info *buf_pair;
364 struct fjes_hw *hw = &adapter->hw;
365 bool reset_flag = false;
366 int result;
367 int epidx;
368
369 for (epidx = 0; epidx < hw->max_epid; epidx++) {
370 if (epidx == hw->my_epid)
371 continue;
372
373 mutex_lock(&hw->hw_info.lock);
374 result = fjes_hw_unregister_buff_addr(hw, epidx);
375 mutex_unlock(&hw->hw_info.lock);
376
377 if (result)
378 reset_flag = true;
379
380 buf_pair = &hw->ep_shm_info[epidx];
381
382 fjes_hw_setup_epbuf(&buf_pair->tx,
383 netdev->dev_addr, netdev->mtu);
384
385 clear_bit(epidx, &hw->txrx_stop_req_bit);
386 }
387
388 if (reset_flag || adapter->force_reset) {
389 result = fjes_hw_reset(hw);
390
391 adapter->force_reset = false;
392
393 if (result)
394 adapter->open_guard = true;
395
396 hw->hw_info.buffer_share_bit = 0;
397
398 memset((void *)&param, 0, sizeof(param));
399
400 param.req_len = hw->hw_info.req_buf_size;
401 param.req_start = __pa(hw->hw_info.req_buf);
402 param.res_len = hw->hw_info.res_buf_size;
403 param.res_start = __pa(hw->hw_info.res_buf);
404 param.share_start = __pa(hw->hw_info.share->ep_status);
405
406 fjes_hw_init_command_registers(hw, &param);
407 }
408}
409
Taku Izumib772b9d2015-08-21 17:29:25 +0900410static void fjes_raise_intr_rxdata_task(struct work_struct *work)
411{
412 struct fjes_adapter *adapter = container_of(work,
413 struct fjes_adapter, raise_intr_rxdata_task);
414 struct fjes_hw *hw = &adapter->hw;
415 enum ep_partner_status pstatus;
416 int max_epid, my_epid, epid;
417
418 my_epid = hw->my_epid;
419 max_epid = hw->max_epid;
420
421 for (epid = 0; epid < max_epid; epid++)
422 hw->ep_shm_info[epid].tx_status_work = 0;
423
424 for (epid = 0; epid < max_epid; epid++) {
425 if (epid == my_epid)
426 continue;
427
428 pstatus = fjes_hw_get_partner_ep_status(hw, epid);
429 if (pstatus == EP_PARTNER_SHARED) {
430 hw->ep_shm_info[epid].tx_status_work =
431 hw->ep_shm_info[epid].tx.info->v1i.tx_status;
432
433 if (hw->ep_shm_info[epid].tx_status_work ==
434 FJES_TX_DELAY_SEND_PENDING) {
435 hw->ep_shm_info[epid].tx.info->v1i.tx_status =
436 FJES_TX_DELAY_SEND_NONE;
437 }
438 }
439 }
440
441 for (epid = 0; epid < max_epid; epid++) {
442 if (epid == my_epid)
443 continue;
444
445 pstatus = fjes_hw_get_partner_ep_status(hw, epid);
446 if ((hw->ep_shm_info[epid].tx_status_work ==
447 FJES_TX_DELAY_SEND_PENDING) &&
448 (pstatus == EP_PARTNER_SHARED) &&
449 !(hw->ep_shm_info[epid].rx.info->v1i.rx_status)) {
450 fjes_hw_raise_interrupt(hw, epid,
451 REG_ICTL_MASK_RX_DATA);
452 }
453 }
454
455 usleep_range(500, 1000);
456}
457
Taku Izumi9acf51c2015-08-21 17:29:24 +0900458static int fjes_tx_send(struct fjes_adapter *adapter, int dest,
459 void *data, size_t len)
460{
461 int retval;
462
463 retval = fjes_hw_epbuf_tx_pkt_send(&adapter->hw.ep_shm_info[dest].tx,
464 data, len);
465 if (retval)
466 return retval;
467
468 adapter->hw.ep_shm_info[dest].tx.info->v1i.tx_status =
469 FJES_TX_DELAY_SEND_PENDING;
Taku Izumib772b9d2015-08-21 17:29:25 +0900470 if (!work_pending(&adapter->raise_intr_rxdata_task))
471 queue_work(adapter->txrx_wq,
472 &adapter->raise_intr_rxdata_task);
Taku Izumi9acf51c2015-08-21 17:29:24 +0900473
474 retval = 0;
475 return retval;
476}
477
478static netdev_tx_t
479fjes_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
480{
481 struct fjes_adapter *adapter = netdev_priv(netdev);
482 struct fjes_hw *hw = &adapter->hw;
483
484 int max_epid, my_epid, dest_epid;
485 enum ep_partner_status pstatus;
486 struct netdev_queue *cur_queue;
487 char shortpkt[VLAN_ETH_HLEN];
488 bool is_multi, vlan;
489 struct ethhdr *eth;
490 u16 queue_no = 0;
491 u16 vlan_id = 0;
492 netdev_tx_t ret;
493 char *data;
494 int len;
495
496 ret = NETDEV_TX_OK;
497 is_multi = false;
498 cur_queue = netdev_get_tx_queue(netdev, queue_no);
499
500 eth = (struct ethhdr *)skb->data;
501 my_epid = hw->my_epid;
502
503 vlan = (vlan_get_tag(skb, &vlan_id) == 0) ? true : false;
504
505 data = skb->data;
506 len = skb->len;
507
508 if (is_multicast_ether_addr(eth->h_dest)) {
509 dest_epid = 0;
510 max_epid = hw->max_epid;
511 is_multi = true;
512 } else if (is_local_ether_addr(eth->h_dest)) {
513 dest_epid = eth->h_dest[ETH_ALEN - 1];
514 max_epid = dest_epid + 1;
515
516 if ((eth->h_dest[0] == 0x02) &&
517 (0x00 == (eth->h_dest[1] | eth->h_dest[2] |
518 eth->h_dest[3] | eth->h_dest[4])) &&
519 (dest_epid < hw->max_epid)) {
520 ;
521 } else {
522 dest_epid = 0;
523 max_epid = 0;
524 ret = NETDEV_TX_OK;
525
526 adapter->stats64.tx_packets += 1;
527 hw->ep_shm_info[my_epid].net_stats.tx_packets += 1;
528 adapter->stats64.tx_bytes += len;
529 hw->ep_shm_info[my_epid].net_stats.tx_bytes += len;
530 }
531 } else {
532 dest_epid = 0;
533 max_epid = 0;
534 ret = NETDEV_TX_OK;
535
536 adapter->stats64.tx_packets += 1;
537 hw->ep_shm_info[my_epid].net_stats.tx_packets += 1;
538 adapter->stats64.tx_bytes += len;
539 hw->ep_shm_info[my_epid].net_stats.tx_bytes += len;
540 }
541
542 for (; dest_epid < max_epid; dest_epid++) {
543 if (my_epid == dest_epid)
544 continue;
545
546 pstatus = fjes_hw_get_partner_ep_status(hw, dest_epid);
547 if (pstatus != EP_PARTNER_SHARED) {
548 ret = NETDEV_TX_OK;
549 } else if (!fjes_hw_check_epbuf_version(
550 &adapter->hw.ep_shm_info[dest_epid].rx, 0)) {
551 /* version is NOT 0 */
552 adapter->stats64.tx_carrier_errors += 1;
553 hw->ep_shm_info[my_epid].net_stats
554 .tx_carrier_errors += 1;
555
556 ret = NETDEV_TX_OK;
557 } else if (!fjes_hw_check_mtu(
558 &adapter->hw.ep_shm_info[dest_epid].rx,
559 netdev->mtu)) {
560 adapter->stats64.tx_dropped += 1;
561 hw->ep_shm_info[my_epid].net_stats.tx_dropped += 1;
562 adapter->stats64.tx_errors += 1;
563 hw->ep_shm_info[my_epid].net_stats.tx_errors += 1;
564
565 ret = NETDEV_TX_OK;
566 } else if (vlan &&
567 !fjes_hw_check_vlan_id(
568 &adapter->hw.ep_shm_info[dest_epid].rx,
569 vlan_id)) {
570 ret = NETDEV_TX_OK;
571 } else {
572 if (len < VLAN_ETH_HLEN) {
573 memset(shortpkt, 0, VLAN_ETH_HLEN);
574 memcpy(shortpkt, skb->data, skb->len);
575 len = VLAN_ETH_HLEN;
576 data = shortpkt;
577 }
578
579 if (adapter->tx_retry_count == 0) {
580 adapter->tx_start_jiffies = jiffies;
581 adapter->tx_retry_count = 1;
582 } else {
583 adapter->tx_retry_count++;
584 }
585
586 if (fjes_tx_send(adapter, dest_epid, data, len)) {
587 if (is_multi) {
588 ret = NETDEV_TX_OK;
589 } else if (
590 ((long)jiffies -
591 (long)adapter->tx_start_jiffies) >=
592 FJES_TX_RETRY_TIMEOUT) {
593 adapter->stats64.tx_fifo_errors += 1;
594 hw->ep_shm_info[my_epid].net_stats
595 .tx_fifo_errors += 1;
596 adapter->stats64.tx_errors += 1;
597 hw->ep_shm_info[my_epid].net_stats
598 .tx_errors += 1;
599
600 ret = NETDEV_TX_OK;
601 } else {
602 netdev->trans_start = jiffies;
603 netif_tx_stop_queue(cur_queue);
604
605 ret = NETDEV_TX_BUSY;
606 }
607 } else {
608 if (!is_multi) {
609 adapter->stats64.tx_packets += 1;
610 hw->ep_shm_info[my_epid].net_stats
611 .tx_packets += 1;
612 adapter->stats64.tx_bytes += len;
613 hw->ep_shm_info[my_epid].net_stats
614 .tx_bytes += len;
615 }
616
617 adapter->tx_retry_count = 0;
618 ret = NETDEV_TX_OK;
619 }
620 }
621 }
622
623 if (ret == NETDEV_TX_OK) {
624 dev_kfree_skb(skb);
625 if (is_multi) {
626 adapter->stats64.tx_packets += 1;
627 hw->ep_shm_info[my_epid].net_stats.tx_packets += 1;
628 adapter->stats64.tx_bytes += 1;
629 hw->ep_shm_info[my_epid].net_stats.tx_bytes += len;
630 }
631 }
632
633 return ret;
634}
635
Taku Izumie5d486d2015-08-21 17:29:23 +0900636static irqreturn_t fjes_intr(int irq, void *data)
637{
638 struct fjes_adapter *adapter = data;
639 struct fjes_hw *hw = &adapter->hw;
640 irqreturn_t ret;
641 u32 icr;
642
643 icr = fjes_hw_capture_interrupt_status(hw);
644
645 if (icr & REG_IS_MASK_IS_ASSERT)
646 ret = IRQ_HANDLED;
647 else
648 ret = IRQ_NONE;
649
650 return ret;
651}
652
Taku Izumi658d4392015-08-21 17:29:17 +0900653/* fjes_probe - Device Initialization Routine */
654static int fjes_probe(struct platform_device *plat_dev)
655{
Taku Izumi2fcbca62015-08-21 17:29:20 +0900656 struct fjes_adapter *adapter;
657 struct net_device *netdev;
658 struct resource *res;
659 struct fjes_hw *hw;
660 int err;
661
662 err = -ENOMEM;
663 netdev = alloc_netdev_mq(sizeof(struct fjes_adapter), "es%d",
664 NET_NAME_UNKNOWN, fjes_netdev_setup,
665 FJES_MAX_QUEUES);
666
667 if (!netdev)
668 goto err_out;
669
670 SET_NETDEV_DEV(netdev, &plat_dev->dev);
671
672 dev_set_drvdata(&plat_dev->dev, netdev);
673 adapter = netdev_priv(netdev);
674 adapter->netdev = netdev;
675 adapter->plat_dev = plat_dev;
676 hw = &adapter->hw;
677 hw->back = adapter;
678
679 /* setup the private structure */
680 err = fjes_sw_init(adapter);
681 if (err)
682 goto err_free_netdev;
683
684 adapter->force_reset = false;
685 adapter->open_guard = false;
686
Taku Izumib772b9d2015-08-21 17:29:25 +0900687 adapter->txrx_wq = create_workqueue(DRV_NAME "/txrx");
688
689 INIT_WORK(&adapter->raise_intr_rxdata_task,
690 fjes_raise_intr_rxdata_task);
691
Taku Izumi2fcbca62015-08-21 17:29:20 +0900692 res = platform_get_resource(plat_dev, IORESOURCE_MEM, 0);
693 hw->hw_res.start = res->start;
694 hw->hw_res.size = res->end - res->start + 1;
695 hw->hw_res.irq = platform_get_irq(plat_dev, 0);
696 err = fjes_hw_init(&adapter->hw);
697 if (err)
698 goto err_free_netdev;
699
700 /* setup MAC address (02:00:00:00:00:[epid])*/
701 netdev->dev_addr[0] = 2;
702 netdev->dev_addr[1] = 0;
703 netdev->dev_addr[2] = 0;
704 netdev->dev_addr[3] = 0;
705 netdev->dev_addr[4] = 0;
706 netdev->dev_addr[5] = hw->my_epid; /* EPID */
707
708 err = register_netdev(netdev);
709 if (err)
710 goto err_hw_exit;
711
712 netif_carrier_off(netdev);
713
Taku Izumi658d4392015-08-21 17:29:17 +0900714 return 0;
Taku Izumi2fcbca62015-08-21 17:29:20 +0900715
716err_hw_exit:
717 fjes_hw_exit(&adapter->hw);
718err_free_netdev:
719 free_netdev(netdev);
720err_out:
721 return err;
Taku Izumi658d4392015-08-21 17:29:17 +0900722}
723
724/* fjes_remove - Device Removal Routine */
725static int fjes_remove(struct platform_device *plat_dev)
726{
Taku Izumi2fcbca62015-08-21 17:29:20 +0900727 struct net_device *netdev = dev_get_drvdata(&plat_dev->dev);
728 struct fjes_adapter *adapter = netdev_priv(netdev);
729 struct fjes_hw *hw = &adapter->hw;
730
Taku Izumib772b9d2015-08-21 17:29:25 +0900731 cancel_work_sync(&adapter->raise_intr_rxdata_task);
732 if (adapter->txrx_wq)
733 destroy_workqueue(adapter->txrx_wq);
734
Taku Izumi2fcbca62015-08-21 17:29:20 +0900735 unregister_netdev(netdev);
736
737 fjes_hw_exit(hw);
738
739 free_netdev(netdev);
740
Taku Izumi658d4392015-08-21 17:29:17 +0900741 return 0;
742}
743
Taku Izumi2fcbca62015-08-21 17:29:20 +0900744static int fjes_sw_init(struct fjes_adapter *adapter)
745{
746 return 0;
747}
748
749/* fjes_netdev_setup - netdevice initialization routine */
750static void fjes_netdev_setup(struct net_device *netdev)
751{
752 ether_setup(netdev);
753
754 netdev->watchdog_timeo = FJES_TX_RETRY_INTERVAL;
755 netdev->netdev_ops = &fjes_netdev_ops;
756 netdev->mtu = fjes_support_mtu[0];
757 netdev->flags |= IFF_BROADCAST;
758 netdev->features |= NETIF_F_HW_CSUM | NETIF_F_HW_VLAN_CTAG_FILTER;
759}
760
Taku Izumi658d4392015-08-21 17:29:17 +0900761/* fjes_init_module - Driver Registration Routine */
762static int __init fjes_init_module(void)
763{
764 int result;
765
766 pr_info("%s - version %s - %s\n",
767 fjes_driver_string, fjes_driver_version, fjes_copyright);
768
769 result = platform_driver_register(&fjes_driver);
770 if (result < 0)
771 return result;
772
773 result = acpi_bus_register_driver(&fjes_acpi_driver);
774 if (result < 0)
775 goto fail_acpi_driver;
776
777 return 0;
778
779fail_acpi_driver:
780 platform_driver_unregister(&fjes_driver);
781 return result;
782}
783
784module_init(fjes_init_module);
785
786/* fjes_exit_module - Driver Exit Cleanup Routine */
787static void __exit fjes_exit_module(void)
788{
789 acpi_bus_unregister_driver(&fjes_acpi_driver);
790 platform_driver_unregister(&fjes_driver);
791}
792
793module_exit(fjes_exit_module);