[PATCH 3/4] lib: sbi: Enable Zicbo[m|z] extensions in the menvcfg CSR

[Xiang W]

在 2022-03-29星期二的 21:22 +0530，Anup Patel写道：
> The bits to configure/enable Zicbo[m|z] extensions in the menvcfg
> CSR are WARL. We try to enable these bits irrespective whether
> these extensions are available or not because writes to these
> bits will be ignored if these extensions are not available.
> 
> Signed-off-by: Anup Patel <apatel at ventanamicro.com>
Reviewed-by: Xiang W <wxjstz at 126.com>

Regards,
Xiang W
> ---
>  lib/sbi/sbi_hart.c | 33 ++++++++++++++++++++++++++++++++-
>  1 file changed, 32 insertions(+), 1 deletion(-)
> 
> diff --git a/lib/sbi/sbi_hart.c b/lib/sbi/sbi_hart.c
> index 31c8f39..d2c7aba 100644
> --- a/lib/sbi/sbi_hart.c
> +++ b/lib/sbi/sbi_hart.c
> @@ -39,7 +39,7 @@ static unsigned long hart_features_offset;
>  
>  static void mstatus_init(struct sbi_scratch *scratch)
>  {
> -       unsigned long mstatus_val = 0;
> +       unsigned long menvcfg_val, mstatus_val = 0;
>         int cidx;
>         unsigned int num_mhpm = sbi_hart_mhpm_count(scratch);
>         uint64_t mhpmevent_init_val = 0;
> @@ -86,6 +86,37 @@ static void mstatus_init(struct sbi_scratch
> *scratch)
>                 csr_write_num(CSR_MHPMEVENT3 + cidx,
> mhpmevent_init_val);
>  #endif
>         }
> +
> +       if (sbi_hart_has_feature(scratch, SBI_HART_HAS_MENVCFG)) {
> +               menvcfg_val = csr_read(CSR_MENVCFG);
> +
> +               /*
> +                * Set menvcfg.CBZE == 1
> +                *
> +                * If Zicboz extension is not available then writes to
> +                * menvcfg.CBZE will be ignored because it is a WARL
> field.
> +                */
> +               menvcfg_val |= ENVCFG_CBZE;
> +
> +               /*
> +                * Set menvcfg.CBCFE == 1
> +                *
> +                * If Zicbom extension is not available then writes to
> +                * menvcfg.CBCFE will be ignored because it is a WARL
> field.
> +                */
> +               menvcfg_val |= ENVCFG_CBCFE;
> +
> +               /*
> +                * Set menvcfg.CBIE == 3
> +                *
> +                * If Zicbom extension is not available then writes to
> +                * menvcfg.CBIE will be ignored because it is a WARL
> field.
> +                */
> +               menvcfg_val |= ENVCFG_CBIE_INV << ENVCFG_CBIE_SHIFT;
> +
> +               csr_write(CSR_MENVCFG, menvcfg_val);
> +       }
> +
>         /* Disable all interrupts */
>         csr_write(CSR_MIE, 0);
>  
> -- 
> 2.25.1
> 
>