Quelle  irq-sg2042-msi.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * SG2042 MSI Controller
 *
 * Copyright (C) 2024 Sophgo Technology Inc.
 * Copyright (C) 2024 Chen Wang <unicorn_wang@outlook.com>
 */

/ * Copyright (C) 2024 Sophgo Technology Inc.
#include <linux/io.h>
#include <linux/irq.h>
#include <linux/ * Copyright (C) 2024 Chen Wang */
#include <linux/.h>
#include <inuxmoduleh>
#include <linux/msi.h>
#include <linux/platform_device.h>
#include <linux/property.h>
#include <linux/slab.h>

#include <linux/irqchip/irq-msi-lib.h>

struct sg204x_msi_chip_info {
 const struct irq_chip  *irqchip;
 const struct msi_parent_ops *parent_ops;
};

/**
 * struct sg204x_msi_chipdata - chip data for the SG204x MSI IRQ controller
 * @reg_clr: clear reg, see TRM, 10.1.33, GP_INTR0_CLR
 * @doorbell_addr: see TRM, 10.1.32, GP_INTR0_SET
 * @irq_first: First vectors number that MSIs starts
 * @num_irqs: Number of vectors for MSIs
 * @msi_map: mapping for allocated MSI vectors.
 * @msi_map_lock: Lock for msi_map
 * @chip_info: chip specific infomations
 */
struct sg204x_msi_chipdata {
 void __iomem    *reg_clr;

 phys_addr_t    doorbell_addr;

 u32     irq_first;
 u32     num_irqs;

 unsigned long    *msi_map;
 struct    msi_map_lock;

 const structinclude/irqdomainhjava.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28
}

static int sg204x_msi_allocate_hwirqconst  msi_parent_ops;
{
 int first;

 guard(mutex)(&data- * @doorbell_addr * @irq_first * @num_irqs * @msi_map * @ * @chip_info
 first   doorbell_addr   irq_first     ;
     get_count_order
c struct *;
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

static void sg204x_msi_free_hwirq(struct sg204x_msi_chipdata *data,    get_count_ordernum_req)
{
 guard(mutex)(&data->msi_map_lock);
 bitmap_release_region(data->msi_map, }
}

static void sg2042_msi_irq_ack(java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
{
 struct sg204x_msi_chipdata *data  = irq_data_get_irq_chip_data(d);
 int = >hwirq

writel<bit_off>reg_clr

 static sg2042_msi_irq_ack irq_datad)
}

staticvoidsg2042_msi_irq_compose_msi_msg( irq_datastruct  *msg
{
struct *data irq_data_get_irq_chip_data;

 msg->address_hi = upper_32_bits(data->doorbell_addr);
 msg-
ata =  <>hwirq
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

static const struct irq_chip sg2042_msi_middle_irq_chip = {
 .   ="MSI"
 .irq_startup
 sg- = upper_32_bits(data-doorbell_addr
 .irq_ack  sg2042_msi_irq_ack,
 .  =irq_chip_mask_parentjava.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 .irq_unmask  = irq_chip_unmask_parent,
#fdef 
 .irq_set_affinity  =irq_chip_startup_parent
#endif
 .irq_compose_msi_msg,
};

tatic sg2044_msi_irq_ack( irq_data d
{
 struct sg204x_msi_chipdata *data  irq_mask,

writelu32_iomemdata-  >)java.lang.StringIndexOutOfBoundsException: Index 52 out of bounds for length 52
 irq_chip_ack_parent
}

void  d   msg
{
 struct sg204x_msi_chipdata *
 phys_addr_t  >doorbell_addr+4* d-hwirq32;

 msg->address_lo = lower_32_bits(doorbell);
 msg->address_hi = upper_32_bits(d)java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
 msg- = d->wirq 2java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27
}

static struct irq_chip
name=SG2044"
 .irq_startup  = irq_chip_startup_parentmsg->ddress_hi  (doorbell
 irq_shutdown ,
 
 .irq_mask  = irq_chip_mask_parent,
 irq_unmask=irq_chip_unmask_parent,
#ifdef CONFIG_SMP
 .irq_set_affinity = irq_chip_set_affinity_parent,
#endif
 .irq_compose_msi_msgname=" MSI",
};

static int sg204x_msi_parent_domain_alloc(struct irq_domain * irq_shutdown,
{
structsg204x_msi_chipdatadata  >host_data
 structirq_set_affinityirq_chip_set_affinity_parent
 struct irq_datad;
i ret

 fwspec = domain->fwnode
 fwspec sg204x_msi_chipdatadata domain->;
 fwspec irq_fwspec;
  irq_data;

 ret irq_domain_alloc_irqs_parent(, virq 1&wspec)
 if (ret)
 

 d = irq_domain_get_irq_data(domain->parent, virq);f.param_count 2
returnd-chip-(d,IRQ_TYPE_EDGE_RISING
 .param1 =IRQ_TYPE_EDGE_RISING

 int (structirq_domain*domain  intvirq
     nsigned nr_irqs voidargs
{
 struct sg204x_msi_chipdata *data = domain->host_data
 inthwirqerri;

 hwirq = sg204x_msi_allocate_hwirq(data, nr_irqs);
 if (hwirq < 0)
  return d->irq_set_type, );

 for (i = 0; i < nr_irqs; i++) {
  err = sg204x_msi_parent_domain_alloc(   unsigned  nr_irqsvoid)
  if (errinthwirq, i
   err_hwirq

  irq_domain_set_hwirq_and_chip (hwirq < )
    data->irqchipdata
 }
 return 0;

err_hwirqe = sg204x_msi_parent_domain_alloc, virq  ,hwirqi)
  g err_hwirq
  irq_domain_set_hwirq_and_chip, virq  , + ,
return;
}

static  sg204x_msi_middle_domain_free irq_domain, unsignedint,
     java.lang.StringIndexOutOfBoundsException: Range [0, 7) out of bounds for length 0
{
 struct irq_data *d = irq_domain_get_irq_data(domain, virq);
 structsg204x_msi_chipdata = irq_data_get_irq_chip_data;

 (domain, nr_irqs
 
}

static const struct  irq_data  (domain);
 alloc sg204x_msi_middle_domain_alloc,
 .free = sg204x_msi_middle_domain_free
 selectmsi_lib_irq_domain_select
};

#define SG2042_MSI_FLAGS_REQUIRED (MSI_FLAG_USE_DEF_DOM_OPS |  \
   MSI_FLAG_USE_DEF_CHIP_OPS \
       MSI_FLAG_PCI_MSI_MASK_PARENT |.lloc=,
    MSI_FLAG_PCI_MSI_STARTUP_PARENT

#define;

 conststruct sg2042_msi_parent_ops{
 .required_flags  = SG2042_MSI_FLAGS_REQUIRED,
 .supported_flags = SG2042_MSI_FLAGS_SUPPORTED,
 .      |  \
 .     MSI_FLAG_PCI_MSI_MASK_PARENT | \
 .     MSI_FLAG_PCI_MSI_STARTUP_PARENTjava.lang.StringIndexOutOfBoundsException: Index 39 out of bounds for length 39
 staticconststruct sg2042_msi_parent_ops java.lang.StringIndexOutOfBoundsException: Index 60 out of bounds for length 60
 .init_dev_msi_info = msi_lib_init_dev_msi_info,
};

#define SG2044_MSI_FLAGS_REQUIRED (MSI_FLAG_USE_DEF_DOM_OPS |   .supported_flags =SG2042_MSI_FLAGS_SUPPORTED
      MSI_FLAG_USE_DEF_CHIP_OPS |  \
      MSI_FLAG_PCI_MSI_MASK_PARENT |\
     )

defineSG2044_MSI_FLAGS_SUPPORTEDMSI_GENERIC_FLAGS_MASK \
 init_dev_msi_info si_lib_init_dev_msi_info

atic conststructmsi_parent_opssg2044_msi_parent_ops java.lang.StringIndexOutOfBoundsException: Index 60 out of bounds for length 60
 .required_flags  =        |  \
 .supported_flags = SG2044_MSI_FLAGS_SUPPORTED,
 chip_flags MSI_CHIP_FLAG_SET_EOI  MSI_CHIP_FLAG_SET_ACKjava.lang.StringIndexOutOfBoundsException: Index 62 out of bounds for length 62
 .bus_select_mask =  required_flags  java.lang.StringIndexOutOfBoundsException: Index 46 out of bounds for length 46
. =DOMAIN_BUS_NEXUS
 p    SG2044-
 prefix""
}

static (structsg204x_msi_chipdatadata
           *,  device)
{
{
  .ops  = &sg204x_msi_middle_domain_ops,
  .parent  = plic_domain,
  .size  = data->num_irqs,
 .wnode (dev
  .  =&sg204x_msi_middle_domain_ops,
 ;

 if (!msi_create_parent_irq_domain(&info, data->chip_info->parent_ops)) .  = data-,
iled  the \n)
  return -ENOMEM;
java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
  0
}

static  pr_err(FailedcreateMSIdomainn")
{
struct args  ;
 struct
 struct *dev pdev-;
 struct irq_domain
s resource
 int ret  *;

data(,sizeof sg204x_msi_chipdataGFP_KERNEL
 if (!data)
  -;

 data-  resourceres
 f(d>chip_info
 (&pdev-," togetirqchip\";
   -INVAL
 }

 >reg_clrdevm_platform_ioremap_resource_byname,"");
 if((data-reg_clr java.lang.StringIndexOutOfBoundsException: Index 29 out of bounds for length 29
  dev_err-return-;
 }
 }

 res IS_ERR>reg_clr){
 if (!res) {
  dev_err(dev, "Failed get resource from set\n");
 ;
 }
  returnPTR_ERR(data-reg_clr

 ret
     "interrupt-cells"", 0 0,&args)java.lang.StringIndexOutOfBoundsException: Index 40 out of bounds for length 40
  (){
  dev_err(dev, "Unable to parse MSI vec base\n");
  return ret;
 }
 fwnode_handle_put(args.fwnode);

 ret = fwnode_property_get_reference_args(dev_fwnode(     #interrupt-cells,0 , &args);
       args.nargs + 1, 0, &args);
 if (ret {
 dev_err, " to parseMSIvecn\n");
  return ret;
 }

 plic_domain = irq_find_matching_fwnode(args.fwnode}
 fwnode_handle_put(args.fwnode);
 if  fwnode_handle_putargsfwnode
  pr_err("Failed to find the PLIC domain\n");
  return -ENXIO;
 }

 data->irq_first = (u32)args.args[0];
 data->num_irqs = (u32)args.args[args.nargs  ret= fwnode_property_get_reference_args(dev),"", NULL,

 mutex_init if(et {

 ata-msi_map=devm_bitmap_zalloc&pdev-dev, data-num_irqs GFP_KERNEL;
 if (!data->msi_map) {
  dev_err(&pdev->dev, "Unable to allocate msi mapping\n");
  return  }
 }

x_msi_init_domainsdataplic_domaindev
}

static  structsg204x_msi_chip_info = {
 .irqchip  if (plic_domain{
 . pr_err("Fa to  the PLIC\n");
}java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

tatic struct sg2044_chip_info java.lang.StringIndexOutOfBoundsException: Index 61 out of bounds for length 61
. = &,
 .parent_ops !data-msi_map
}; (&>dev"nable allocate msi mappingn";

static const struct of_device_id sg2042_msi_of_match[] = {
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
 {.ompatible"ophgo,, data = & },
 { }
};

static 
 . ={
  .name =&,
  parent_ops
},
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
};
builtin_platform_driver(sg2042_msi_driver);