developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
| 2 | /* |
| 3 | * Copyright (c) 2023 Mediatek Inc. All Rights Reserved. |
| 4 | * |
| 5 | * Author: Ren-Ting Wang <ren-ting.wang@mediatek.com> |
| 6 | */ |
| 7 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 8 | #include <linux/bitmap.h> |
| 9 | #include <linux/bitops.h> |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 10 | #include <linux/err.h> |
| 11 | #include <linux/lockdep.h> |
| 12 | #include <linux/spinlock.h> |
| 13 | |
| 14 | #include "pce/cls.h" |
| 15 | #include "pce/internal.h" |
| 16 | #include "pce/netsys.h" |
| 17 | |
| 18 | struct cls_hw { |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 19 | struct cls_entry cls_tbl[FE_MEM_CLS_MAX_INDEX]; |
| 20 | DECLARE_BITMAP(cls_used, FE_MEM_CLS_MAX_INDEX); |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 21 | spinlock_t lock; |
| 22 | }; |
| 23 | |
| 24 | struct cls_hw cls_hw; |
| 25 | |
| 26 | int mtk_pce_cls_enable(void) |
| 27 | { |
| 28 | mtk_pce_netsys_setbits(GLO_MEM_CFG, GDM_CLS_EN); |
| 29 | |
| 30 | return 0; |
| 31 | } |
| 32 | |
| 33 | void mtk_pce_cls_disable(void) |
| 34 | { |
| 35 | mtk_pce_netsys_clrbits(GLO_MEM_CFG, GDM_CLS_EN); |
| 36 | } |
| 37 | |
| 38 | static void mtk_pce_cls_clean_up(void) |
| 39 | { |
| 40 | struct fe_mem_msg msg = { |
| 41 | .cmd = FE_MEM_CMD_WRITE, |
| 42 | .type = FE_MEM_TYPE_CLS, |
| 43 | }; |
| 44 | unsigned long flag; |
| 45 | int ret = 0; |
| 46 | u32 i = 0; |
| 47 | |
| 48 | memset(&msg.raw, 0, sizeof(msg.raw)); |
| 49 | |
| 50 | spin_lock_irqsave(&cls_hw.lock, flag); |
| 51 | |
| 52 | /* clean up cls table */ |
| 53 | for (i = 0; i < FE_MEM_CLS_MAX_INDEX; i++) { |
| 54 | msg.index = i; |
| 55 | ret = mtk_pce_fe_mem_msg_send(&msg); |
| 56 | if (ret) |
| 57 | goto unlock; |
| 58 | } |
| 59 | |
| 60 | unlock: |
| 61 | spin_unlock_irqrestore(&cls_hw.lock, flag); |
| 62 | } |
| 63 | |
| 64 | int mtk_pce_cls_init(struct platform_device *pdev) |
| 65 | { |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 66 | u32 i; |
| 67 | |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 68 | spin_lock_init(&cls_hw.lock); |
| 69 | |
| 70 | mtk_pce_cls_clean_up(); |
| 71 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 72 | for (i = 0; i < FE_MEM_CLS_MAX_INDEX; i++) |
| 73 | cls_hw.cls_tbl[i].idx = i + 1; |
| 74 | |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 75 | return 0; |
| 76 | } |
| 77 | |
| 78 | void mtk_pce_cls_deinit(struct platform_device *pdev) |
| 79 | { |
| 80 | mtk_pce_cls_clean_up(); |
| 81 | } |
| 82 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 83 | int mtk_pce_cls_desc_read(struct cls_desc *cdesc, u32 idx) |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 84 | { |
| 85 | struct fe_mem_msg msg; |
| 86 | int ret; |
| 87 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 88 | if (unlikely(!cdesc || !idx || idx >= FE_MEM_CLS_MAX_INDEX)) |
| 89 | return -EINVAL; |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 90 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 91 | mtk_pce_fe_mem_msg_config(&msg, FE_MEM_CMD_READ, FE_MEM_TYPE_CLS, idx); |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 92 | |
| 93 | memset(&msg.raw, 0, sizeof(msg.raw)); |
| 94 | |
| 95 | ret = mtk_pce_fe_mem_msg_send(&msg); |
| 96 | if (ret) |
| 97 | return ret; |
| 98 | |
| 99 | memcpy(cdesc, &msg.cdesc, sizeof(struct cls_desc)); |
| 100 | |
| 101 | return ret; |
| 102 | } |
| 103 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 104 | int mtk_pce_cls_desc_write(struct cls_desc *cdesc, u32 idx) |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 105 | { |
| 106 | struct fe_mem_msg msg; |
| 107 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 108 | if (unlikely(!cdesc || !idx || idx >= FE_MEM_CLS_MAX_INDEX)) |
| 109 | return -EINVAL; |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 110 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 111 | mtk_pce_fe_mem_msg_config(&msg, FE_MEM_CMD_WRITE, FE_MEM_TYPE_CLS, idx); |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 112 | |
| 113 | memset(&msg.raw, 0, sizeof(msg.raw)); |
| 114 | memcpy(&msg.cdesc, cdesc, sizeof(struct cls_desc)); |
| 115 | |
| 116 | return mtk_pce_fe_mem_msg_send(&msg); |
| 117 | } |
| 118 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 119 | int mtk_pce_cls_entry_write(struct cls_entry *cls) |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 120 | { |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 121 | if (unlikely(!cls)) |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 122 | return -EINVAL; |
| 123 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 124 | return mtk_pce_cls_desc_write(&cls->cdesc, cls->idx); |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 125 | } |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 126 | EXPORT_SYMBOL(mtk_pce_cls_entry_write); |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 127 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 128 | struct cls_entry *mtk_pce_cls_entry_alloc(void) |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 129 | { |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 130 | struct cls_entry *cls; |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 131 | unsigned long flag; |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 132 | u32 idx; |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 133 | |
| 134 | spin_lock_irqsave(&cls_hw.lock, flag); |
| 135 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 136 | idx = find_first_zero_bit(cls_hw.cls_used, FE_MEM_CLS_MAX_INDEX); |
| 137 | if (idx == FE_MEM_CLS_MAX_INDEX) { |
| 138 | cls = ERR_PTR(-ENOMEM); |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 139 | goto unlock; |
| 140 | } |
| 141 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 142 | set_bit(idx, cls_hw.cls_used); |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 143 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 144 | cls = &cls_hw.cls_tbl[idx]; |
| 145 | |
| 146 | memset(&cls->cdesc, 0, sizeof(cls->cdesc)); |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 147 | |
| 148 | unlock: |
| 149 | spin_unlock_irqrestore(&cls_hw.lock, flag); |
| 150 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 151 | return cls; |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 152 | } |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 153 | EXPORT_SYMBOL(mtk_pce_cls_entry_alloc); |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 154 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 155 | void mtk_pce_cls_entry_free(struct cls_entry *cls) |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 156 | { |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 157 | unsigned long flag; |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 158 | |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 159 | if (!cls) |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 160 | return; |
| 161 | |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 162 | spin_lock_irqsave(&cls_hw.lock, flag); |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 163 | clear_bit(cls->idx - 1, cls_hw.cls_used); |
developer | 1966afb | 2023-08-08 16:02:18 +0800 | [diff] [blame] | 164 | spin_unlock_irqrestore(&cls_hw.lock, flag); |
| 165 | } |
developer | 5cca2e4 | 2023-08-24 17:39:15 +0800 | [diff] [blame] | 166 | EXPORT_SYMBOL(mtk_pce_cls_entry_free); |