Create vendor variants of the existing extension helpers. If the
existing functions were instead modified to support vendor extensions, a
branch based on the ext value being greater than
RISCV_ISA_VENDOR_EXT_BASE would have to be introduced. This additional
branch would have an unnecessary performance impact.

Signed-off-by: Charlie Jenkins <[email protected]>
---
 arch/riscv/include/asm/cpufeature.h | 54 +++++++++++++++++++++++++++++++++++++
 arch/riscv/kernel/cpufeature.c      | 34 ++++++++++++++++++++---
 2 files changed, 84 insertions(+), 4 deletions(-)

diff --git a/arch/riscv/include/asm/cpufeature.h 
b/arch/riscv/include/asm/cpufeature.h
index db2ab037843a..8f19e3681b4f 100644
--- a/arch/riscv/include/asm/cpufeature.h
+++ b/arch/riscv/include/asm/cpufeature.h
@@ -89,6 +89,10 @@ bool __riscv_isa_extension_available(const unsigned long 
*isa_bitmap, unsigned i
 #define riscv_isa_extension_available(isa_bitmap, ext) \
        __riscv_isa_extension_available(isa_bitmap, RISCV_ISA_EXT_##ext)
 
+bool __riscv_isa_vendor_extension_available(const unsigned long 
*vendor_isa_bitmap, unsigned int bit);
+#define riscv_isa_vendor_extension_available(isa_bitmap, ext)  \
+       __riscv_isa_vendor_extension_available(isa_bitmap, 
RISCV_ISA_VENDOR_EXT_##ext)
+
 static __always_inline bool
 __riscv_has_extension_likely_alternatives(const unsigned long ext)
 {
@@ -117,6 +121,8 @@ __riscv_has_extension_unlikely_alternatives(const unsigned 
long ext)
        return true;
 }
 
+/* Standard extension helpers */
+
 static __always_inline bool
 riscv_has_extension_likely(const unsigned long ext)
 {
@@ -163,4 +169,52 @@ static __always_inline bool 
riscv_cpu_has_extension_unlikely(int cpu, const unsi
                return __riscv_isa_extension_available(hart_isa[cpu].isa, ext);
 }
 
+/* Vendor extension helpers */
+
+static __always_inline bool
+riscv_has_vendor_extension_likely(const unsigned long ext)
+{
+       compiletime_assert(ext < RISCV_ISA_VENDOR_EXT_MAX,
+                          "ext must be < RISCV_ISA_VENDOR_EXT_MAX");
+
+       if (IS_ENABLED(CONFIG_RISCV_ALTERNATIVE))
+               return __riscv_has_extension_likely_alternatives(ext);
+       else
+               return __riscv_isa_vendor_extension_available(NULL, ext);
+}
+
+static __always_inline bool
+riscv_has_vendor_extension_unlikely(const unsigned long ext)
+{
+       compiletime_assert(ext < RISCV_ISA_VENDOR_EXT_MAX,
+                          "ext must be < RISCV_ISA_VENDOR_EXT_MAX");
+
+       if (IS_ENABLED(CONFIG_RISCV_ALTERNATIVE))
+               return __riscv_has_extension_unlikely_alternatives(ext);
+       else
+               return __riscv_isa_vendor_extension_available(NULL, ext);
+}
+
+static __always_inline bool riscv_cpu_has_vendor_extension_likely(int cpu, 
const unsigned long ext)
+{
+       compiletime_assert(ext < RISCV_ISA_VENDOR_EXT_MAX,
+                          "ext must be < RISCV_ISA_VENDOR_EXT_MAX");
+
+       if (IS_ENABLED(CONFIG_RISCV_ALTERNATIVE))
+               return __riscv_has_extension_likely_alternatives(ext);
+       else
+               return 
__riscv_isa_vendor_extension_available(hart_isa_vendor[cpu].isa, ext);
+}
+
+static __always_inline bool riscv_cpu_has_vendor_extension_unlikely(int cpu, 
const unsigned long ext)
+{
+       compiletime_assert(ext < RISCV_ISA_VENDOR_EXT_MAX,
+                          "ext must be < RISCV_ISA_VENDOR_EXT_MAX");
+
+       if (IS_ENABLED(CONFIG_RISCV_ALTERNATIVE))
+               return __riscv_has_extension_unlikely_alternatives(ext);
+       else
+               return 
__riscv_isa_vendor_extension_available(hart_isa_vendor[cpu].isa, ext);
+}
+
 #endif
diff --git a/arch/riscv/kernel/cpufeature.c b/arch/riscv/kernel/cpufeature.c
index f72fbdd0d7f5..41a4d2028428 100644
--- a/arch/riscv/kernel/cpufeature.c
+++ b/arch/riscv/kernel/cpufeature.c
@@ -78,6 +78,29 @@ bool __riscv_isa_extension_available(const unsigned long 
*isa_bitmap, unsigned i
 }
 EXPORT_SYMBOL_GPL(__riscv_isa_extension_available);
 
+/**
+ * __riscv_isa_vendor_extension_available() - Check whether given vendor
+ * extension is available or not
+ *
+ * @isa_bitmap: ISA bitmap to use
+ * @bit: bit position of the desired extension
+ * Return: true or false
+ *
+ * NOTE: If isa_bitmap is NULL then Host ISA bitmap will be used.
+ */
+bool __riscv_isa_vendor_extension_available(const unsigned long *isa_bitmap, 
unsigned int bit)
+{
+       const unsigned long *bmap = (isa_bitmap) ? isa_bitmap : 
riscv_isa_vendor;
+
+       bit -= RISCV_ISA_VENDOR_EXT_BASE;
+
+       if (bit < 0 || bit >= RISCV_ISA_VENDOR_EXT_MAX)
+               return false;
+
+       return test_bit(bit, bmap) ? true : false;
+}
+EXPORT_SYMBOL_GPL(__riscv_isa_vendor_extension_available);
+
 static bool riscv_isa_extension_check(int id)
 {
        switch (id) {
@@ -930,14 +953,17 @@ void __init_or_module riscv_cpufeature_patch_func(struct 
alt_entry *begin,
 
                id = PATCH_ID_CPUFEATURE_ID(alt->patch_id);
 
-               if (id >= RISCV_ISA_EXT_MAX) {
+               if (id >= RISCV_ISA_VENDOR_EXT_BASE) {
+                       if (!__riscv_isa_vendor_extension_available(NULL, id))
+                               continue;
+               } else if (id < RISCV_ISA_EXT_MAX) {
+                       if (!__riscv_isa_extension_available(NULL, id))
+                               continue;
+               } else {
                        WARN(1, "This extension id:%d is not in ISA extension 
list", id);
                        continue;
                }
 
-               if (!__riscv_isa_extension_available(NULL, id))
-                       continue;
-
                value = PATCH_ID_CPUFEATURE_VALUE(alt->patch_id);
                if (!riscv_cpufeature_patch_check(id, value))
                        continue;

-- 
2.44.0


Reply via email to