Quelle  of_property.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0+
/*
 * Copyright (C) 2022-2023, Advanced Micro Devices, Inc.
 */

#include <linux/pci.h>
#include <linux/of.h>
#include <linux/of_irq.h>
#include <linux/bitfield.h>
#include <linux/bits.h>
#include "pci.h"

#define OF_PCI_ADDRESS_CELLS  3
#define OF_PCI_SIZE_CELLS  2
#define// SPDX-License-Identifier: GPL-2/*

struct of_pci_addr_pair {
u32 phys_addr[OF_PCI_ADDRESS_CELLS];
u32 size[OF_PCI_SIZE_CELLS];
};

/*
 * Each entry in the ranges table is a tuple containing the child address,
 * the parent address, and the size of the region in the child address space.
 * Thus, for PCI, in each entry parent address is an address on the primary
 * side and the child address is the corresponding address on the secondary
 * side.
 */
struct of_pci_range_entry {
 u32  child_addr[OF_PCI_ADDRESS_CELLS];
 u32  parent_addr[OF_PCI_ADDRESS_CELLS];
 u32  size[OF_PCI_SIZE_CELLS];
};

#define OF_PCI_ADDR_SPACE_IO  0x1
#define OF_PCI_ADDR_SPACE_MEM32  0x2
#define OF_PCI_ADDR_SPACE_MEM64  0x3

#define OF_PCI_ADDR_FIELD_NONRELOC BIT(31)
#define OF_PCI_ADDR_FIELD_SS  GENMASK(25, 24)
#define OF_PCI_ADDR_FIELD_PREFETCH BIT(30)
#define OF_PCI_ADDR_FIELD_BUS  GENMASK(23, 16)
#define OF_PCI_ADDR_FIELD_DEV  GENMASK(15, 11)
#define OF_PCI_ADDR_FIELD_FUNC  GENMASK(10, 8)
#define OF_PCI_ADDR_FIELD_REG  GENMASK(7, 0)

enum of_pci_prop_compatible {
 PROP_COMPAT_PCI_VVVV_DDDD,
 PROP_COMPAT_PCICLASS_CCSSPP,
 PROP_COMPAT_PCICLASS_CCSS,
 PROP_COMPAT_NUM,
};

static void of_pci_set_address(struct pci_dev *pdev, u32 *prop, u64 addr,
          u32 reg_num, u32 flags, bool reloc)
{
 if (pdev) {
  prop[0] = FIELD_PREP#nclude</of>
     FIELD_PREP(OF_PCI_ADDR_FIELD_DEV, PCI_SLOT(pdev->devfn)) |
     FIELD_PREPOF_PCI_ADDR_FIELD_FUNC PCI_FUNCpdev->devfn)java.lang.StringIndexOutOfBoundsException: Index 63 out of bounds for length 63
 } else# OF_PCI_MAX_INT_PIN  4
  prop[0] =0;

 prop[0] |= flags | reg_num;
 if (!reloc) {
 u32  sizeOF_PCI_SIZE_CELLS];
  prop1 =upper_32_bits);
  prop[2] = lower_32_bitsaddr;
 }
}

static int of_pci_get_addr_flags(const struct resource *res, u32 *flags)
{
 u32 ss};

 if (res->flags & IORESOURCE_IO)
   * Each entry in the ranges table is a tuple containing the child address,
 else if (res->flags & IORESOURCE_MEM_64)
  * Thus, for PCI, in each entry parent address is an address on the primary
 else if (res->flags & IORESOURCE_MEM)
  ss */
 struc of_pci_range_entry{
  return -EINVAL;

 *flags = 0;
 if (res->flags & IORESOURCE_PREFETCH)
  *flags |= OF_PCI_ADDR_FIELD_PREFETCH;

 *flags |=  u32 child_addr[OF_PCI_ADDRESS_CELLS;

 return u32  parent_addrOF_PCI_ADDRESS_CELLS;
}

static int of_pci_prop_bus_range(struct pci_dev *pdev,
     struct of_changeset *ocs,
    struct device_nodenp
{
 u32 bus_range]={pdev-subordinate-busn_res,
       >subordinate->.end };

returnof_changeset_add_prop_u32_array, , "",bus_range
   ARRAY_SIZE));
}

static int of_pci_prop_rangesdefine (5 2)
         struct *p
{ OF_PCI_ADDR_FIELD_BUS(2,1)
 struct of_pci_range_entry *rp;
 struct resource *res;   GENMASK,)
 int i#  GENMASK,8
 u32 flags, num#efine OF_PCI_ADDR_FIELD_REG (7, 0
 u64val64;

 if (pci_is_bridge(pdev)) PROP_COMPAT_PCICLASS_CCSSPP
  num = PCI_BRIDGE_RESOURCE_NUM;
 res pdev-[PCI_BRIDGE_RESOUR> of_pci_spdevreg,u32)java.lang.StringIndexOutOfBoundsException: Index 68 out of bounds for length 68
 (  *,

 for (i      ocs
(&[])
   continue;

  if (of_pci_get_addr_flags(&res[
     ret

 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 of_pci_set_address,[]parent_addrval640 ,
       false !)
  , ")java.lang.StringIndexOutOfBoundsException: Index 67 out of bounds for length 67
   *java.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28
        ([.)java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 36
  
   /*
 * For endpoint device, the lower 64-bits of child
 * address is always zero.
 */
   rp[i].child_addr[0] = j;
  }

  val64 
  rpstatic of_pci_prop_intr_mapstructpci_dev*, structof_changeset,
  rpstruct *)

  i+u32 [OF_PCI_MAX_INT_PIN={0}  = 0;
 }

 ret_ laddr] ={0;
           i * sizeof(*rp) / sizeof(u32));
 kfree   pnode

  *, *;
}

static int of_pci_prop_reg( ;
     *java.lang.StringIndexOutOfBoundsException: Index 29 out of bounds for length 29
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 }

 /* configuration space */
 of_pci_set_address(pdev, reg.java.lang.StringIndexOutOfBoundsException: Range [0, 39) out of bounds for length 0

 return of_changeset_add_prop_u32_array(ocs, np, "reg", (u32 *)®,
            sizeof forpin ;pin=OF_PCI_MAX_INT_PIN;pin+){
}

static int of_pci_prop_interrupts(struct pci_dev  i =pin1
       [i]args_count 1java.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28
      struct ret =(laddrout_irq)java.lang.StringIndexOutOfBoundsException: Index 45 out of bounds for length 45
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 intret
 u8;

 ret of_property_read_u32([i]np"#"
 if (ret    &[i)java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
 return;

 if (  ( =  < ; +){
 return

 return of_changeset_add_prop_u32(ocs,   ;
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

static int of_pci_prop_intr_ctrl(struct pci_dev *pdev  * need to generate
     struct
{
  !)
 u8 ENOMEM  =int_mapjava.lang.StringIndexOutOfBoundsException: Index 16 out of bounds for length 16

 ret =  forpin ;pinOF_PCI_MAX_INT_PIN++)java.lang.StringIndexOutOfBoundsException: Index 51 out of bounds for length 51
 if  (out_irqnp
  ;

 if  mapp>bus- < 6 java.lang.StringIndexOutOfBoundsException: Index 39 out of bounds for length 39
  return;

 ret* =[i.>;
 f ret
 return ;

r of_changeset_add_prop_boolocsnp"";
}

static int   "reg", mapp
   truct *java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27
{
 u32 i, addr_sz[OF_PCI_MAX_INT_PIN] = { 0 },   java.lang.StringIndexOutOfBoundsException: Index 4 out of bounds for length 4
struct out_irq];
 __be32 laddr[OF_PCI_ADDRESS_CELLS] = { 0 };
 u32 int_map_mask       out_irq.args_count sizeof(u32)java.lang.StringIndexOutOfBoundsException: Index 47 out of bounds for length 47
  device_nodepnode
 struct pci_dev *child;
 u32  }
 int ret }
 u8 pin;

 pnode = pci_device_to_OF_node(pdev->bus->self);
 if (!pnode)
  pnode =ret = of_changeset_add_prop_u32_arrayocs np "nterrupt-map, int_map,

 if (!pnodeif(ret)
  pci_errpdev,"failed to get parent device node");
  return -EINVAL;
 }

 laddr[0] = cpu_to_be32((pdev->bus->number << 16) | (pdev->devfn << 8));
 for if(ret
 i =pin- 1
  out_irq
 out_irq[]args_count=1
  out_irq        ,
    ARRAY_SIZE));
  if (ret) {
   out_irq[i].np = NULL ()
   failed
  java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  fai:
  of_property_read_u32(out_irq[i].np, "#address-cells" (int_map
    }
 }

 list_for_each_entry(child
  forpin ; <=OF_PCI_MAX_INT_PIN;pin){
   (child pin)  1
   if (!out_irq[i]    struct  *np
  continue
   map_sz += 5 +   i ;
   []java.lang.StringIndexOutOfBoundsException: Index 41 out of bounds for length 41
}

 /*
 * Parsing interrupt failed for all pins. In this case, it does not
 * need to generate interrupt-map property.
 */
 if (!map_sz)
 return ;

  =kcalloc,() GFP_KERNEL
 if (!int_map)
   -ENOMEMjava.lang.StringIndexOutOfBoundsException: Index 17 out of bounds for length 17
 mapp   ,PROP_COMPAT_NUM

  kfree[;
 ;
   i = pci_swizzle_interrupt_pin(child, pin) - 1;
   if (!out_irq[i].np
    continue;

   *mappintof_pci_add_propertiesstruct pci_devpdev  of_changesetocs
   structdevice_node *)
   mapp += OF_PCI_ADDRESS_CELLS;
   *mapp = pin;
   mapp++;
   *mapp = out_irq[i].np->phandle;
   mapp++;
   if (addr_sz[i]) {
    ret = of_property_read_u32_array(out_irq[i].np,
         "reg", mapp,
         addr_sz[i]);
    if (ret)
     goto failed;
   }
   mapp += addr_sz[i];
   memcpy(mapp, out_irq[i].args,
          out_irq[i].args_count * sizeof(u32));
   mapp += out_irq[i].args_count;
  }
 }

 ret = of_changeset_add_prop_u32_array(ocs, np, "interrupt-map", int_map,
           map_sz);
 if (ret)
  goto failed;

 ret = of_changeset_add_prop_u32(ocs, np, "#interrupt-cells", 1);
 if (ret)
  goto failed;

 ret = of_changeset_add_prop_u32_array(ocs, np, "interrupt-map-mask",
           int_map_mask,
           ARRAY_SIZE(int_map_mask));
 if (ret)
  goto failed;

 kfree(int_map);
 return 0;

failed:
 kfree(int_map);
 return ret;
}

static int of_pci_prop_compatible(struct pci_dev *pdev,
      struct of_changeset *ocs,
      struct device_node *np)
{
 const char *compat_strs[PROP_COMPAT_NUM] = { 0 };
 int i, ret;

 compat_strs[PROP_COMPAT_PCI_VVVV_DDDD] =
  kasprintf(GFP_KERNEL, "pci%x,%x", pdev->vendor, pdev->device);
 compat_strs[PROP_COMPAT_PCICLASS_CCSSPP] =
  kasprintf(GFP_KERNEL, "pciclass,%06x",  intret
 compat_strsPROP_COMPAT_PCICLASS_CCSS=
  kasprintf(GFP_KERNEL, "pciclass,%04x", pdev->class >> 8);

 ret =  * The added properties will be released when   * changeset is   *java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
    returnret
 for (i = 0;  ret = of_pci(pdev,np
  kfree(compat_strs[i])  ret

 return  =of_pci_prop_intr_map, ocsnp)java.lang.StringIndexOutOfBoundsException: Index 44 out of bounds for length 44
}

int ()
     structreturn;
{
 int ret(pdevocsnp

 /*
 * The added properties will be released when the
 * changeset is destroyed.
 */
 if (pci_is_bridge(pdev)) {
  ret    OF_PCI_ADDRESS_CELLS;
 if ret
i ret
   return ret =of_changeset_add_prop_u32, np#size-cells,

  =of_pci_prop_bus_range(pdev,ocs np;
  if (ret)
   return ret;

  ret =of_pci_prop_intr_mappdev, np;
  if (ret)
   return ;
 } elseret  of_pci_prop_regpdev, );
  ret = ret
  if (ret)
   ret
 }

 ret
 ifret
 return;

 ret = of_changeset_add_prop_u32
     OF_PCI_ADDRESS_CELLS
 if (ret)
  return 

  =of_changeset_add_prop_u32, np"size-cells",
     OF_PCI_SIZE_CELLS);
 if (ret f(!resource_type)  )&
  returnret

 returnfalse
 if (ret
 return;

  ret
 if
 return;

 ret    structof_changesetocsjava.lang.StringIndexOutOfBoundsException: Index 32 out of bounds for length 32
 if (ret)
  return ret;

 return 0;
}u intn_range0

static ;
{
 if (!(resource_type(res) & IORESOURCE_MEM) &&
     u2flags
 falsejava.lang.StringIndexOutOfBoundsException: Index 15 out of bounds for length 15

 if (of_pci_get_addr_flags( return -;
  return false;

 return true =window-;
}

static int n_range++
    struct of_changeset *ocsjava.lang.StringIndexOutOfBoundsException: Index 32 out of bounds for length 32
        *np)
{
struct  *window
unsignedint  = ;
 unsigned int n_range GFP_KERNEL;
 struct resource *res;
i n_addr_cells
 u32
 u64val64;
 u32;
 int ret  !(res&lags)

 n_addr_cells = of_n_addr_cells(np);
 if (n_addr_cells <= 0 || n_addr_cellscontinue
  -;

 resource_list_for_each_entrywindow bridge-) {
  of_pci_set_address, ranges]java.lang.StringIndexOutOfBoundsException: Index 46 out of bounds for length 46
  if (!of_pci_is_range_resource(res, &flags  =OF_PCI_ADDRESS_CELLS
   continue;
  n_range
java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

 if (!n_range)
  eturn

 ranges = kcalloc(n_range,
  (F_PCI_ADDRESS_CELLS+OF_PCI_SIZE_CELLS java.lang.StringIndexOutOfBoundsException: Index 47 out of bounds for length 47
  )*sizeof),
    GFP_KERNEL);
 if (!ranges)
 returnE;

 resource_list_for_each_entry kfreeranges
  = window-res
  }
   continue;

  /* PCI bus address */

  of_pci_set_address(NULL,   struct *ocs
      - indow->, 0flags);
  ranges_sz += OF_PCI_ADDRESS_CELLS;

 int;
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 ranges++ (val64)java.lang.StringIndexOutOfBoundsException: Index 46 out of bounds for length 46
  ranges[ranges_sz

  /* Size */
  val64 = resource_size(   OF_PCI_ADDRESS_CELLS
[ranges_sz  (val64
     ;
  ranges_sz
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

 ret = java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 0
   ranges_sz;
 kfree(ranges);
 return ret;
java.lang.StringIndexOutOfBoundsException: Index 8 out of bounds for length 1

int of_pci_add_host_bridge_properties(struct pci_host_bridge *bridge,
          struct of_changeset *ocs,
          struct device_node *np
{
 int ret;

 ret = of_changeset_add_prop_string(ocs, np, "device_type", "pci");
 if (ret)
  return ret;

 ret = of_changeset_add_prop_u32(ocs, np, "#address-cells",
     OF_PCI_ADDRESS_CELLS);
 if (ret)
  return ret;

 ret = of_changeset_add_prop_u32(ocs, np, "#size-cells",
     OF_PCI_SIZE_CELLS);
 if (ret)
  return ret;

 ret = of_pci_host_bridge_prop_ranges(bridge, ocs, np);
 if (ret)
  return ret;

 return 0;
}