bus/dpaa: remove logically dead code
[dpdk.git] / drivers / bus / dpaa / base / fman / fman.c
1 /* SPDX-License-Identifier: (BSD-3-Clause OR GPL-2.0)
2  *
3  * Copyright 2010-2016 Freescale Semiconductor Inc.
4  * Copyright 2017-2020 NXP
5  *
6  */
7
8 #include <sys/types.h>
9 #include <sys/ioctl.h>
10 #include <ifaddrs.h>
11
12 /* This header declares the driver interface we implement */
13 #include <fman.h>
14 #include <dpaa_of.h>
15 #include <rte_malloc.h>
16 #include <rte_dpaa_logs.h>
17 #include <rte_string_fns.h>
18
19 #define QMI_PORT_REGS_OFFSET            0x400
20
21 /* CCSR map address to access ccsr based register */
22 void *fman_ccsr_map;
23 /* fman version info */
24 u16 fman_ip_rev;
25 static int get_once;
26 u32 fman_dealloc_bufs_mask_hi;
27 u32 fman_dealloc_bufs_mask_lo;
28
29 int fman_ccsr_map_fd = -1;
30 static COMPAT_LIST_HEAD(__ifs);
31
32 /* This is the (const) global variable that callers have read-only access to.
33  * Internally, we have read-write access directly to __ifs.
34  */
35 const struct list_head *fman_if_list = &__ifs;
36
37 static void
38 if_destructor(struct __fman_if *__if)
39 {
40         struct fman_if_bpool *bp, *tmpbp;
41
42         if (!__if)
43                 return;
44
45         if (__if->__if.mac_type == fman_offline)
46                 goto cleanup;
47
48         list_for_each_entry_safe(bp, tmpbp, &__if->__if.bpool_list, node) {
49                 list_del(&bp->node);
50                 free(bp);
51         }
52 cleanup:
53         free(__if);
54 }
55
56 static int
57 fman_get_ip_rev(const struct device_node *fman_node)
58 {
59         const uint32_t *fman_addr;
60         uint64_t phys_addr;
61         uint64_t regs_size;
62         uint32_t ip_rev_1;
63         int _errno;
64
65         fman_addr = of_get_address(fman_node, 0, &regs_size, NULL);
66         if (!fman_addr) {
67                 pr_err("of_get_address cannot return fman address\n");
68                 return -EINVAL;
69         }
70         phys_addr = of_translate_address(fman_node, fman_addr);
71         if (!phys_addr) {
72                 pr_err("of_translate_address failed\n");
73                 return -EINVAL;
74         }
75         fman_ccsr_map = mmap(NULL, regs_size, PROT_READ | PROT_WRITE,
76                              MAP_SHARED, fman_ccsr_map_fd, phys_addr);
77         if (fman_ccsr_map == MAP_FAILED) {
78                 pr_err("Can not map FMan ccsr base");
79                 return -EINVAL;
80         }
81
82         ip_rev_1 = in_be32(fman_ccsr_map + FMAN_IP_REV_1);
83         fman_ip_rev = (ip_rev_1 & FMAN_IP_REV_1_MAJOR_MASK) >>
84                         FMAN_IP_REV_1_MAJOR_SHIFT;
85
86         _errno = munmap(fman_ccsr_map, regs_size);
87         if (_errno)
88                 pr_err("munmap() of FMan ccsr failed");
89
90         return 0;
91 }
92
93 static int
94 fman_get_mac_index(uint64_t regs_addr_host, uint8_t *mac_idx)
95 {
96         int ret = 0;
97
98         /*
99          * MAC1 : E_0000h
100          * MAC2 : E_2000h
101          * MAC3 : E_4000h
102          * MAC4 : E_6000h
103          * MAC5 : E_8000h
104          * MAC6 : E_A000h
105          * MAC7 : E_C000h
106          * MAC8 : E_E000h
107          * MAC9 : F_0000h
108          * MAC10: F_2000h
109          */
110         switch (regs_addr_host) {
111         case 0xE0000:
112                 *mac_idx = 1;
113                 break;
114         case 0xE2000:
115                 *mac_idx = 2;
116                 break;
117         case 0xE4000:
118                 *mac_idx = 3;
119                 break;
120         case 0xE6000:
121                 *mac_idx = 4;
122                 break;
123         case 0xE8000:
124                 *mac_idx = 5;
125                 break;
126         case 0xEA000:
127                 *mac_idx = 6;
128                 break;
129         case 0xEC000:
130                 *mac_idx = 7;
131                 break;
132         case 0xEE000:
133                 *mac_idx = 8;
134                 break;
135         case 0xF0000:
136                 *mac_idx = 9;
137                 break;
138         case 0xF2000:
139                 *mac_idx = 10;
140                 break;
141         default:
142                 ret = -EINVAL;
143         }
144
145         return ret;
146 }
147
148 static int
149 fman_if_init(const struct device_node *dpa_node)
150 {
151         const char *rprop, *mprop;
152         uint64_t phys_addr;
153         struct __fman_if *__if;
154         struct fman_if_bpool *bpool;
155
156         const phandle *mac_phandle, *ports_phandle, *pools_phandle;
157         const phandle *tx_channel_id = NULL, *mac_addr, *cell_idx;
158         const phandle *rx_phandle, *tx_phandle;
159         uint64_t tx_phandle_host[4] = {0};
160         uint64_t rx_phandle_host[4] = {0};
161         uint64_t regs_addr_host = 0;
162         uint64_t cell_idx_host = 0;
163
164         const struct device_node *mac_node = NULL, *tx_node;
165         const struct device_node *pool_node, *fman_node, *rx_node;
166         const uint32_t *regs_addr = NULL;
167         const char *mname, *fname;
168         const char *dname = dpa_node->full_name;
169         size_t lenp;
170         int _errno;
171         const char *char_prop;
172         uint32_t na;
173
174         if (of_device_is_available(dpa_node) == false)
175                 return 0;
176
177         rprop = "fsl,qman-frame-queues-rx";
178         mprop = "fsl,fman-mac";
179
180         /* Allocate an object for this network interface */
181         __if = rte_malloc(NULL, sizeof(*__if), RTE_CACHE_LINE_SIZE);
182         if (!__if) {
183                 FMAN_ERR(-ENOMEM, "malloc(%zu)\n", sizeof(*__if));
184                 goto err;
185         }
186         memset(__if, 0, sizeof(*__if));
187         INIT_LIST_HEAD(&__if->__if.bpool_list);
188         strlcpy(__if->node_name, dpa_node->name, IF_NAME_MAX_LEN - 1);
189         __if->node_name[IF_NAME_MAX_LEN - 1] = '\0';
190         strlcpy(__if->node_path, dpa_node->full_name, PATH_MAX - 1);
191         __if->node_path[PATH_MAX - 1] = '\0';
192
193         /* Obtain the MAC node used by this interface except macless */
194         mac_phandle = of_get_property(dpa_node, mprop, &lenp);
195         if (!mac_phandle) {
196                 FMAN_ERR(-EINVAL, "%s: no %s\n", dname, mprop);
197                 goto err;
198         }
199         assert(lenp == sizeof(phandle));
200         mac_node = of_find_node_by_phandle(*mac_phandle);
201         if (!mac_node) {
202                 FMAN_ERR(-ENXIO, "%s: bad 'fsl,fman-mac\n", dname);
203                 goto err;
204         }
205         mname = mac_node->full_name;
206
207         /* Map the CCSR regs for the MAC node */
208         regs_addr = of_get_address(mac_node, 0, &__if->regs_size, NULL);
209         if (!regs_addr) {
210                 FMAN_ERR(-EINVAL, "of_get_address(%s)\n", mname);
211                 goto err;
212         }
213         phys_addr = of_translate_address(mac_node, regs_addr);
214         if (!phys_addr) {
215                 FMAN_ERR(-EINVAL, "of_translate_address(%s, %p)\n",
216                          mname, regs_addr);
217                 goto err;
218         }
219         __if->ccsr_map = mmap(NULL, __if->regs_size,
220                               PROT_READ | PROT_WRITE, MAP_SHARED,
221                               fman_ccsr_map_fd, phys_addr);
222         if (__if->ccsr_map == MAP_FAILED) {
223                 FMAN_ERR(-errno, "mmap(0x%"PRIx64")\n", phys_addr);
224                 goto err;
225         }
226         na = of_n_addr_cells(mac_node);
227         /* Get rid of endianness (issues). Convert to host byte order */
228         regs_addr_host = of_read_number(regs_addr, na);
229
230
231         /* Get the index of the Fman this i/f belongs to */
232         fman_node = of_get_parent(mac_node);
233         na = of_n_addr_cells(mac_node);
234         if (!fman_node) {
235                 FMAN_ERR(-ENXIO, "of_get_parent(%s)\n", mname);
236                 goto err;
237         }
238         fname = fman_node->full_name;
239         cell_idx = of_get_property(fman_node, "cell-index", &lenp);
240         if (!cell_idx) {
241                 FMAN_ERR(-ENXIO, "%s: no cell-index)\n", fname);
242                 goto err;
243         }
244         assert(lenp == sizeof(*cell_idx));
245         cell_idx_host = of_read_number(cell_idx, lenp / sizeof(phandle));
246         __if->__if.fman_idx = cell_idx_host;
247         if (!get_once) {
248                 _errno = fman_get_ip_rev(fman_node);
249                 if (_errno) {
250                         FMAN_ERR(-ENXIO, "%s: ip_rev is not available\n",
251                                  fname);
252                         goto err;
253                 }
254         }
255
256         if (fman_ip_rev >= FMAN_V3) {
257                 /*
258                  * Set A2V, OVOM, EBD bits in contextA to allow external
259                  * buffer deallocation by fman.
260                  */
261                 fman_dealloc_bufs_mask_hi = FMAN_V3_CONTEXTA_EN_A2V |
262                                                 FMAN_V3_CONTEXTA_EN_OVOM;
263                 fman_dealloc_bufs_mask_lo = FMAN_V3_CONTEXTA_EN_EBD;
264         } else {
265                 fman_dealloc_bufs_mask_hi = 0;
266                 fman_dealloc_bufs_mask_lo = 0;
267         }
268         /* Is the MAC node 1G, 2.5G, 10G? */
269         __if->__if.is_memac = 0;
270
271         if (of_device_is_compatible(mac_node, "fsl,fman-1g-mac"))
272                 __if->__if.mac_type = fman_mac_1g;
273         else if (of_device_is_compatible(mac_node, "fsl,fman-10g-mac"))
274                 __if->__if.mac_type = fman_mac_10g;
275         else if (of_device_is_compatible(mac_node, "fsl,fman-memac")) {
276                 __if->__if.is_memac = 1;
277                 char_prop = of_get_property(mac_node, "phy-connection-type",
278                                             NULL);
279                 if (!char_prop) {
280                         printf("memac: unknown MII type assuming 1G\n");
281                         /* Right now forcing memac to 1g in case of error*/
282                         __if->__if.mac_type = fman_mac_1g;
283                 } else {
284                         if (strstr(char_prop, "sgmii-2500"))
285                                 __if->__if.mac_type = fman_mac_2_5g;
286                         else if (strstr(char_prop, "sgmii"))
287                                 __if->__if.mac_type = fman_mac_1g;
288                         else if (strstr(char_prop, "rgmii")) {
289                                 __if->__if.mac_type = fman_mac_1g;
290                                 __if->__if.is_rgmii = 1;
291                         } else if (strstr(char_prop, "xgmii"))
292                                 __if->__if.mac_type = fman_mac_10g;
293                 }
294         } else {
295                 FMAN_ERR(-EINVAL, "%s: unknown MAC type\n", mname);
296                 goto err;
297         }
298
299         /*
300          * For MAC ports, we cannot rely on cell-index. In
301          * T2080, two of the 10G ports on single FMAN have same
302          * duplicate cell-indexes as the other two 10G ports on
303          * same FMAN. Hence, we now rely upon addresses of the
304          * ports from device tree to deduce the index.
305          */
306
307         _errno = fman_get_mac_index(regs_addr_host, &__if->__if.mac_idx);
308         if (_errno) {
309                 FMAN_ERR(-EINVAL, "Invalid register address: %" PRIx64,
310                          regs_addr_host);
311                 goto err;
312         }
313
314         /* Extract the MAC address for private and shared interfaces */
315         mac_addr = of_get_property(mac_node, "local-mac-address",
316                                    &lenp);
317         if (!mac_addr) {
318                 FMAN_ERR(-EINVAL, "%s: no local-mac-address\n",
319                          mname);
320                 goto err;
321         }
322         memcpy(&__if->__if.mac_addr, mac_addr, ETHER_ADDR_LEN);
323
324         /* Extract the Tx port (it's the second of the two port handles)
325          * and get its channel ID
326          */
327         ports_phandle = of_get_property(mac_node, "fsl,port-handles",
328                                         &lenp);
329         if (!ports_phandle)
330                 ports_phandle = of_get_property(mac_node, "fsl,fman-ports",
331                                                 &lenp);
332         if (!ports_phandle) {
333                 FMAN_ERR(-EINVAL, "%s: no fsl,port-handles\n",
334                          mname);
335                 goto err;
336         }
337         assert(lenp == (2 * sizeof(phandle)));
338         tx_node = of_find_node_by_phandle(ports_phandle[1]);
339         if (!tx_node) {
340                 FMAN_ERR(-ENXIO, "%s: bad fsl,port-handle[1]\n", mname);
341                 goto err;
342         }
343         /* Extract the channel ID (from tx-port-handle) */
344         tx_channel_id = of_get_property(tx_node, "fsl,qman-channel-id",
345                                         &lenp);
346         if (!tx_channel_id) {
347                 FMAN_ERR(-EINVAL, "%s: no fsl-qman-channel-id\n",
348                          tx_node->full_name);
349                 goto err;
350         }
351
352         rx_node = of_find_node_by_phandle(ports_phandle[0]);
353         if (!rx_node) {
354                 FMAN_ERR(-ENXIO, "%s: bad fsl,port-handle[0]\n", mname);
355                 goto err;
356         }
357         regs_addr = of_get_address(rx_node, 0, &__if->regs_size, NULL);
358         if (!regs_addr) {
359                 FMAN_ERR(-EINVAL, "of_get_address(%s)\n", mname);
360                 goto err;
361         }
362         phys_addr = of_translate_address(rx_node, regs_addr);
363         if (!phys_addr) {
364                 FMAN_ERR(-EINVAL, "of_translate_address(%s, %p)\n",
365                          mname, regs_addr);
366                 goto err;
367         }
368         __if->bmi_map = mmap(NULL, __if->regs_size,
369                                  PROT_READ | PROT_WRITE, MAP_SHARED,
370                                  fman_ccsr_map_fd, phys_addr);
371         if (__if->bmi_map == MAP_FAILED) {
372                 FMAN_ERR(-errno, "mmap(0x%"PRIx64")\n", phys_addr);
373                 goto err;
374         }
375
376         /* No channel ID for MAC-less */
377         assert(lenp == sizeof(*tx_channel_id));
378         na = of_n_addr_cells(mac_node);
379         __if->__if.tx_channel_id = of_read_number(tx_channel_id, na);
380
381         /* Extract the Rx FQIDs. (Note, the device representation is silly,
382          * there are "counts" that must always be 1.)
383          */
384         rx_phandle = of_get_property(dpa_node, rprop, &lenp);
385         if (!rx_phandle) {
386                 FMAN_ERR(-EINVAL, "%s: no fsl,qman-frame-queues-rx\n", dname);
387                 goto err;
388         }
389
390         assert(lenp == (4 * sizeof(phandle)));
391
392         na = of_n_addr_cells(mac_node);
393         /* Get rid of endianness (issues). Convert to host byte order */
394         rx_phandle_host[0] = of_read_number(&rx_phandle[0], na);
395         rx_phandle_host[1] = of_read_number(&rx_phandle[1], na);
396         rx_phandle_host[2] = of_read_number(&rx_phandle[2], na);
397         rx_phandle_host[3] = of_read_number(&rx_phandle[3], na);
398
399         assert((rx_phandle_host[1] == 1) && (rx_phandle_host[3] == 1));
400         __if->__if.fqid_rx_err = rx_phandle_host[0];
401         __if->__if.fqid_rx_def = rx_phandle_host[2];
402
403         /* Extract the Tx FQIDs */
404         tx_phandle = of_get_property(dpa_node,
405                                      "fsl,qman-frame-queues-tx", &lenp);
406         if (!tx_phandle) {
407                 FMAN_ERR(-EINVAL, "%s: no fsl,qman-frame-queues-tx\n", dname);
408                 goto err;
409         }
410
411         assert(lenp == (4 * sizeof(phandle)));
412         /*TODO: Fix for other cases also */
413         na = of_n_addr_cells(mac_node);
414         /* Get rid of endianness (issues). Convert to host byte order */
415         tx_phandle_host[0] = of_read_number(&tx_phandle[0], na);
416         tx_phandle_host[1] = of_read_number(&tx_phandle[1], na);
417         tx_phandle_host[2] = of_read_number(&tx_phandle[2], na);
418         tx_phandle_host[3] = of_read_number(&tx_phandle[3], na);
419         assert((tx_phandle_host[1] == 1) && (tx_phandle_host[3] == 1));
420         __if->__if.fqid_tx_err = tx_phandle_host[0];
421         __if->__if.fqid_tx_confirm = tx_phandle_host[2];
422
423         /* Obtain the buffer pool nodes used by this interface */
424         pools_phandle = of_get_property(dpa_node, "fsl,bman-buffer-pools",
425                                         &lenp);
426         if (!pools_phandle) {
427                 FMAN_ERR(-EINVAL, "%s: no fsl,bman-buffer-pools\n", dname);
428                 goto err;
429         }
430         /* For each pool, parse the corresponding node and add a pool object
431          * to the interface's "bpool_list"
432          */
433         assert(lenp && !(lenp % sizeof(phandle)));
434         while (lenp) {
435                 size_t proplen;
436                 const phandle *prop;
437                 uint64_t bpid_host = 0;
438                 uint64_t bpool_host[6] = {0};
439                 const char *pname;
440                 /* Allocate an object for the pool */
441                 bpool = rte_malloc(NULL, sizeof(*bpool), RTE_CACHE_LINE_SIZE);
442                 if (!bpool) {
443                         FMAN_ERR(-ENOMEM, "malloc(%zu)\n", sizeof(*bpool));
444                         goto err;
445                 }
446                 /* Find the pool node */
447                 pool_node = of_find_node_by_phandle(*pools_phandle);
448                 if (!pool_node) {
449                         FMAN_ERR(-ENXIO, "%s: bad fsl,bman-buffer-pools\n",
450                                  dname);
451                         rte_free(bpool);
452                         goto err;
453                 }
454                 pname = pool_node->full_name;
455                 /* Extract the BPID property */
456                 prop = of_get_property(pool_node, "fsl,bpid", &proplen);
457                 if (!prop) {
458                         FMAN_ERR(-EINVAL, "%s: no fsl,bpid\n", pname);
459                         rte_free(bpool);
460                         goto err;
461                 }
462                 assert(proplen == sizeof(*prop));
463                 na = of_n_addr_cells(mac_node);
464                 /* Get rid of endianness (issues).
465                  * Convert to host byte-order
466                  */
467                 bpid_host = of_read_number(prop, na);
468                 bpool->bpid = bpid_host;
469                 /* Extract the cfg property (count/size/addr). "fsl,bpool-cfg"
470                  * indicates for the Bman driver to seed the pool.
471                  * "fsl,bpool-ethernet-cfg" is used by the network driver. The
472                  * two are mutually exclusive, so check for either of them.
473                  */
474                 prop = of_get_property(pool_node, "fsl,bpool-cfg",
475                                        &proplen);
476                 if (!prop)
477                         prop = of_get_property(pool_node,
478                                                "fsl,bpool-ethernet-cfg",
479                                                &proplen);
480                 if (!prop) {
481                         /* It's OK for there to be no bpool-cfg */
482                         bpool->count = bpool->size = bpool->addr = 0;
483                 } else {
484                         assert(proplen == (6 * sizeof(*prop)));
485                         na = of_n_addr_cells(mac_node);
486                         /* Get rid of endianness (issues).
487                          * Convert to host byte order
488                          */
489                         bpool_host[0] = of_read_number(&prop[0], na);
490                         bpool_host[1] = of_read_number(&prop[1], na);
491                         bpool_host[2] = of_read_number(&prop[2], na);
492                         bpool_host[3] = of_read_number(&prop[3], na);
493                         bpool_host[4] = of_read_number(&prop[4], na);
494                         bpool_host[5] = of_read_number(&prop[5], na);
495
496                         bpool->count = ((uint64_t)bpool_host[0] << 32) |
497                                         bpool_host[1];
498                         bpool->size = ((uint64_t)bpool_host[2] << 32) |
499                                         bpool_host[3];
500                         bpool->addr = ((uint64_t)bpool_host[4] << 32) |
501                                         bpool_host[5];
502                 }
503                 /* Parsing of the pool is complete, add it to the interface
504                  * list.
505                  */
506                 list_add_tail(&bpool->node, &__if->__if.bpool_list);
507                 lenp -= sizeof(phandle);
508                 pools_phandle++;
509         }
510
511         /* Parsing of the network interface is complete, add it to the list */
512         DPAA_BUS_LOG(DEBUG, "Found %s, Tx Channel = %x, FMAN = %x,"
513                     "Port ID = %x",
514                     dname, __if->__if.tx_channel_id, __if->__if.fman_idx,
515                     __if->__if.mac_idx);
516
517         list_add_tail(&__if->__if.node, &__ifs);
518         return 0;
519 err:
520         if_destructor(__if);
521         return _errno;
522 }
523
524 int
525 fman_init(void)
526 {
527         const struct device_node *dpa_node;
528         int _errno;
529
530         /* If multiple dependencies try to initialise the Fman driver, don't
531          * panic.
532          */
533         if (fman_ccsr_map_fd != -1)
534                 return 0;
535
536         fman_ccsr_map_fd = open(FMAN_DEVICE_PATH, O_RDWR);
537         if (unlikely(fman_ccsr_map_fd < 0)) {
538                 DPAA_BUS_LOG(ERR, "Unable to open (/dev/mem)");
539                 return fman_ccsr_map_fd;
540         }
541
542         for_each_compatible_node(dpa_node, NULL, "fsl,dpa-ethernet-init") {
543                 _errno = fman_if_init(dpa_node);
544                 if (_errno) {
545                         FMAN_ERR(_errno, "if_init(%s)\n", dpa_node->full_name);
546                         goto err;
547                 }
548         }
549
550         return 0;
551 err:
552         fman_finish();
553         return _errno;
554 }
555
556 void
557 fman_finish(void)
558 {
559         struct __fman_if *__if, *tmpif;
560
561         assert(fman_ccsr_map_fd != -1);
562
563         list_for_each_entry_safe(__if, tmpif, &__ifs, __if.node) {
564                 int _errno;
565
566                 /* disable Rx and Tx */
567                 if ((__if->__if.mac_type == fman_mac_1g) &&
568                     (!__if->__if.is_memac))
569                         out_be32(__if->ccsr_map + 0x100,
570                                  in_be32(__if->ccsr_map + 0x100) & ~(u32)0x5);
571                 else
572                         out_be32(__if->ccsr_map + 8,
573                                  in_be32(__if->ccsr_map + 8) & ~(u32)3);
574                 /* release the mapping */
575                 _errno = munmap(__if->ccsr_map, __if->regs_size);
576                 if (unlikely(_errno < 0))
577                         fprintf(stderr, "%s:%d:%s(): munmap() = %d (%s)\n",
578                                 __FILE__, __LINE__, __func__,
579                                 -errno, strerror(errno));
580                 printf("Tearing down %s\n", __if->node_path);
581                 list_del(&__if->__if.node);
582                 rte_free(__if);
583         }
584
585         close(fman_ccsr_map_fd);
586         fman_ccsr_map_fd = -1;
587 }