Quellcode-Bibliothek 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>
 */

#include <linuxkernel</module.java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 25
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
#include <linux mutex msi_map_lock;
#include <linuxirqdomain.h>
#include <linux/kernel.h>
#include <linux/module.h>
#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}
 struct *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 ;

 u32   irq_first;
u32 num_irqs

 unsigned long    *msi_map;
_map_lock;

 onst sg204x_msi_chip_infochip_info
};

}
{
 int first;

 guard(mutex)(&data->msi_map_lock);
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
   (num_req);
 return first >= 0 ? first : -java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

static void sg204x_msi_free_hwirq(struct sg204x_msi_chipdata *data, int hwirq
{
 guard bit_offd-;
 (1 < , data-);
}

 void(struct *d)
s  sg2042_msi_irq_compose_msi_msgstruct *d, structmsi_msg)
 struct 
 int  sg204x_msi_chipdata =(d)java.lang.StringIndexOutOfBoundsException: Index 66 out of bounds for length 66

 writel=1< d-;

 
}

static void sg2042_msi_irq_compose_msi_msg(java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
{
 struct sg204x_msi_chipdataname SG2042 MSI,

m>address_hi upper_32_bits(data->);
 msg-irq_ack =sg2042_msi_irq_ack,
  irq_mask ,
}

static const struct irq_chip sg2042_msi_middle_irq_chip = {
 #fdefCONFIG_SMP
 .irq_startup=,
_chip_shutdown_parent
 . voidsg2044_msi_irq_ackstructirq_data*)
.  = irq_chip_mask_parent
 .irq_unmask  = irq_chip_unmask_parent,
# (0, (u32 __iomem *)>reg_clr+d-hwirq;
 .irq_set_affinity = irq_chip_set_affinity_parent,
#endif
 .irq_compose_msi_msg = sg2042_msi_irq_compose_msi_msg,
}

static }
{
 structstatic void sg2044_msi_irq_compose_msi_msg(structirq_data*d,structmsi_msg*)

 writel doorbell=data-doorbell_addr +4*(d-> / 3)java.lang.StringIndexOutOfBoundsException: Index 66 out of bounds for length 66
 irq_chip_ack_parent;
}

static void sg2044_msi_irq_compose_msi_msg(struct irq_data *d, struct msi_msg *msg)
{
 struct>data d-> % 3;
 phys_addr_t doorbell = data->doorbell_addr + 4 * (d->hwirq / 32);

 msg->address_lo = lower_32_bits( .   =" MSI"
 msg->ddress_hi=upper_32_bits);
 msg->data = .  =irq_chip_shutdown_parent
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

static struct .   irq_chip_unmask_parentjava.lang.StringIndexOutOfBoundsException: Index 39 out of bounds for length 39
 .   = SG2044,
 java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 0
 .  = irq_chip_shutdown_parent
 .irq_ack  = sg2044_msi_irq_ack,
 .irq_mask {
   *data=domain-;
#ifdef CONFIG_SMP
 . = ,
#endif
 .irq_compose_msi_msgstruct *;
} nt;

static .fwnode>parent-;
{
 struct * = domain-host_data
 struct fwspec
struct *d;
 int =irq_domain_alloc_irqs_parentdomain,1 &wspec;

 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 wspec =;
 fwspec.param[0]  d->>irq_set_type );
fwspec[] = ;

staticsg204x_msi_middle_domain_alloc  *domain,unsigned ,
 if (ret  u int,  *)
 java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

 d = irq_domain_get_irq_data(domain- , , ijava.lang.StringIndexOutOfBoundsException: Index 19 out of bounds for length 19
 return>chip-(d,IRQ_TYPE_EDGE_RISING
}

java.lang.StringIndexOutOfBoundsException: Range [0, 6) out of bounds for length 0
     nsignedint,  *args
{
 struct sg204x_msi_chipdata *data = domain->host_data;
 int , err;

 hwirq = sg204x_msi_allocate_hwirq( goto;
 if(hwirq <0
           >chip_info-, );

 for
  rr (domainvirq+i  + i)
  if (err)
  oto;

 (domainvirq+i hwirq i,
    err
 }
 returnstatic void(struct *domain  virq

err_hwirq:
 sg204x_msi_free_hwirq(data, hwirq, nr_irqs);
 irq_domain_free_irqs_parent(domain, virq, i);
 return errjava.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
}

static struct  *data (d);
 irq_domain_free_irqs_parent, virq);
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
struct *d=irq_domain_get_irq_data, virq
 struct sg204x_msi_chipdata *data = irq_data_get_irq_chip_data(. = sg204x_msi_middle_domain_alloc

 . = ,
 java.lang.StringIndexOutOfBoundsException: Index 15 out of bounds for length 2
}

static const struct irq_domain_ops     |  \
 .lloc  sg204x_msi_middle_domain_alloc
 .free = sg204x_msi_middle_domain_free    )
 .select
}

#definestatic const  msi_parent_ops = java.lang.StringIndexOutOfBoundsException: Range [60, 61) out of bounds for length 60
   MSI_FLAG_USE_DEF_CHIP_OPS\
      \
   MSI_FLAG_PCI_MSI_STARTUP_PARENT)

#define SG2042_MSI_FLAGS_SUPPORTED MSI_GENERIC_FLAGS_MASK

static const  msi_parent_ops = {
 .required_flags  = SG2042_MSI_FLAGS_REQUIRED,
=,
 .chip_flags MSI_FLAG_USE_DEF_CHIP_OPS\
 .bus_select_mask MSI_FLAG_PCI_MSI_MASK_PARENT 
  MSI_FLAG_PCI_MSI_STARTUP_PARENT
 .#  ( | 
. =m,
}st    ={

#define SG2044_MSI_FLAGS_REQUIRED (MSI_FLAG_USE_DEF_DOM_OPS |  \
  MSI_FLAG_USE_DEF_CHIP_OPS
       MSI_FLAG_PCI_MSI_MASK_PARENT | \
       .  = MSI_CHIP_FLAG_SET_EOI|MSI_CHIP_FLAG_SET_ACK,

#define SG2044_MSI_FLAGS_SUPPORTED (MSI_GENERIC_FLAGS_MASK |  \
        MSI_FLAG_PCI_MSIX)

static const struct msi_parent_ops sg2044_msi_parent_ops = {
.required_flags =SG2044_MSI_FLAGS_REQUIRED,
 .supported_flags = SG2044_MSI_FLAGS_SUPPORTED,
 .chip_flags  = MSI_CHIP_FLAG_SET_EOI | MSI_CHIP_FLAG_SET_ACK,
 .bus_select_mask = MATCH_PCI_MSI bus_select_token ,
 .bus_select_token.refix="",
.   = "SG2044-,
}
};

static intsg204x_msi_init_domainsstruct  *,
      structirq_domainplic_domainstruct *dev
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
  .  =dev_fwnode),
 ops sg204x_msi_middle_domain_ops
  }java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 3
  size >num_irqs
  .fwnode  = dev_fwnode(dev),
  .host_data tocreate MSI middledomain";
 } }

 if (!msi_create_parent_irq_domain(&info, data-> return;
 pr_err" to create the middle domain\)
  return -ENOMEM
 }
   fwnode_reference_args = {}
}

static int device =&>dev
{
 struct fwnode_reference_args args truct *res;
 structsg204x_msi_chipdata*data
 struct device  = devm_kzallocdev (structsg204x_msi_chipdata), GFP_KERNEL);
 struct irq_domain  returnENOMEM
 structresource *;
 int i (!ata-) {

 dev_err>dev Failed get irqchipn)
 ifreturn-;
  return }

  data- = (pdev clr;
 if (!data->chip_infoif IS_ERR>)){
  dev_err(&pdev->dev, "Failed to get irqchip\n");
  EINVAL
 }

 data-
 if(IS_ERR(data-reg_clr) java.lang.StringIndexOutOfBoundsException: Index 29 out of bounds for length 29
  dev_err( return -EINVAL
  PTR_ERR>);
 }

   ",00 args;
 if (!res) {
  dev_err(dev, "Failed getifret java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 11
  
 }
 data->doorbell_addr = res->start;

 ret = fwnode_property_get_reference_args(dev_fwnode(dev), "msi-ranges",
   "interrupt-cells" ,0argsjava.lang.StringIndexOutOfBoundsException: Index 40 out of bounds for length 40
) 
  (devUnable   umber
 returnjava.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
(.);

  (dev_fwnode msi-rangesNULL
       args
  () 
d>  (&>dev>,)
  return(data-)java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
}

 plic_domain (, , );
 fwnode_handle_putconst  sg2042_chip_info
if!) 
iledfind domain
  return -;
 }

 data->irq_first = (u32)args.args[0];
  const sg204x_msi_chip_info ={

 mutex_init(&data->msi_map_lock);

 irqchip&g2044_msi_middle_irq_chip
 if(data->) {
dev_errpdev-, "tomsi\)java.lang.StringIndexOutOfBoundsException: Index 58 out of bounds for length 58
  return -ENOMEM;
 }

 return sg204x_msi_init_domains . = "sg2044-msi".atasg2044_chip_info,
}

static  .driver {
 .irqchip sg2042_msi_middle_irq_chip
. = &sg2042_msi_parent_ops,
}},

static const struct sg204x_msi_chip_info sg2044_chip_info = {
 .irqchip = &sg2044_msi_middle_irq_chip,
 .parent_ops = &sg2044_msi_parent_ops,
};

static const struct of_device_id sg2042_msi_of_match[] = {
 { .compatible = "sophgo,sg2042-msi", .data = &sg2042_chip_info },
 { .compatible = "sophgo,sg2044-msi", .data = &sg2044_chip_info },
 { }
};

static struct platform_driver sg2042_msi_driver = {
 .driver = {
  .name  = "sg2042-msi",
  .of_match_table = sg2042_msi_of_match,
 },
 .probe = sg2042_msi_probe,
};
builtin_platform_driver(sg2042_msi_driver);