1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /**************************************************************************** |
3 | * Driver for Solarflare network controllers and boards |
4 | * Copyright 2005-2006 Fen Systems Ltd. |
5 | * Copyright 2006-2013 Solarflare Communications Inc. |
6 | */ |
7 | |
8 | #include <linux/module.h> |
9 | #include <linux/mtd/mtd.h> |
10 | #include <linux/slab.h> |
11 | #include <linux/rtnetlink.h> |
12 | |
13 | #include "net_driver.h" |
14 | #include "efx.h" |
15 | |
16 | #define to_efx_mtd_partition(mtd) \ |
17 | container_of(mtd, struct efx_mtd_partition, mtd) |
18 | |
19 | /* MTD interface */ |
20 | |
21 | static int efx_mtd_erase(struct mtd_info *mtd, struct erase_info *erase) |
22 | { |
23 | struct efx_nic *efx = mtd->priv; |
24 | |
25 | return efx->type->mtd_erase(mtd, erase->addr, erase->len); |
26 | } |
27 | |
28 | static void efx_mtd_sync(struct mtd_info *mtd) |
29 | { |
30 | struct efx_mtd_partition *part = to_efx_mtd_partition(mtd); |
31 | struct efx_nic *efx = mtd->priv; |
32 | int rc; |
33 | |
34 | rc = efx->type->mtd_sync(mtd); |
35 | if (rc) |
36 | pr_err("%s: %s sync failed (%d)\n" , |
37 | part->name, part->dev_type_name, rc); |
38 | } |
39 | |
40 | static void efx_mtd_remove_partition(struct efx_mtd_partition *part) |
41 | { |
42 | int rc; |
43 | |
44 | for (;;) { |
45 | rc = mtd_device_unregister(master: &part->mtd); |
46 | if (rc != -EBUSY) |
47 | break; |
48 | ssleep(seconds: 1); |
49 | } |
50 | WARN_ON(rc); |
51 | list_del(entry: &part->node); |
52 | } |
53 | |
54 | int efx_mtd_add(struct efx_nic *efx, struct efx_mtd_partition *parts, |
55 | size_t n_parts, size_t sizeof_part) |
56 | { |
57 | struct efx_mtd_partition *part; |
58 | size_t i; |
59 | |
60 | for (i = 0; i < n_parts; i++) { |
61 | part = (struct efx_mtd_partition *)((char *)parts + |
62 | i * sizeof_part); |
63 | |
64 | part->mtd.writesize = 1; |
65 | |
66 | if (!(part->mtd.flags & MTD_NO_ERASE)) |
67 | part->mtd.flags |= MTD_WRITEABLE; |
68 | |
69 | part->mtd.owner = THIS_MODULE; |
70 | part->mtd.priv = efx; |
71 | part->mtd.name = part->name; |
72 | part->mtd._erase = efx_mtd_erase; |
73 | part->mtd._read = efx->type->mtd_read; |
74 | part->mtd._write = efx->type->mtd_write; |
75 | part->mtd._sync = efx_mtd_sync; |
76 | |
77 | efx->type->mtd_rename(part); |
78 | |
79 | if (mtd_device_register(&part->mtd, NULL, 0)) |
80 | goto fail; |
81 | |
82 | /* Add to list in order - efx_mtd_remove() depends on this */ |
83 | list_add_tail(new: &part->node, head: &efx->mtd_list); |
84 | } |
85 | |
86 | return 0; |
87 | |
88 | fail: |
89 | while (i--) { |
90 | part = (struct efx_mtd_partition *)((char *)parts + |
91 | i * sizeof_part); |
92 | efx_mtd_remove_partition(part); |
93 | } |
94 | /* Failure is unlikely here, but probably means we're out of memory */ |
95 | return -ENOMEM; |
96 | } |
97 | |
98 | void efx_mtd_remove(struct efx_nic *efx) |
99 | { |
100 | struct efx_mtd_partition *parts, *part, *next; |
101 | |
102 | WARN_ON(efx_dev_registered(efx)); |
103 | |
104 | if (list_empty(head: &efx->mtd_list)) |
105 | return; |
106 | |
107 | parts = list_first_entry(&efx->mtd_list, struct efx_mtd_partition, |
108 | node); |
109 | |
110 | list_for_each_entry_safe(part, next, &efx->mtd_list, node) |
111 | efx_mtd_remove_partition(part); |
112 | |
113 | kfree(objp: parts); |
114 | } |
115 | |
116 | void efx_mtd_rename(struct efx_nic *efx) |
117 | { |
118 | struct efx_mtd_partition *part; |
119 | |
120 | ASSERT_RTNL(); |
121 | |
122 | list_for_each_entry(part, &efx->mtd_list, node) |
123 | efx->type->mtd_rename(part); |
124 | } |
125 | |