static int msm_spmi_probe(struct udevice *dev) { struct udevice *parent = dev->parent; struct msm_spmi_priv *priv = dev_get_priv(dev); int node = dev_of_offset(dev); int i; priv->arb_chnl = devfdt_get_addr(dev); priv->spmi_core = fdtdec_get_addr_size_auto_parent(gd->fdt_blob, dev_of_offset(parent), node, "reg", 1, NULL, false); priv->spmi_obs = fdtdec_get_addr_size_auto_parent(gd->fdt_blob, dev_of_offset(parent), node, "reg", 2, NULL, false); if (priv->arb_chnl == FDT_ADDR_T_NONE || priv->spmi_core == FDT_ADDR_T_NONE || priv->spmi_obs == FDT_ADDR_T_NONE) return -EINVAL; /* Scan peripherals connected to each SPMI channel */ for (i = 0; i < SPMI_MAX_CHANNELS ; i++) { uint32_t periph = readl(priv->arb_chnl + ARB_CHANNEL_OFFSET(i)); uint8_t slave_id = (periph & 0xf0000) >> 16; uint8_t pid = (periph & 0xff00) >> 8; priv->channel_map[slave_id][pid] = i; } return 0; }
static int simple_video_probe(struct udevice *dev) { struct video_uc_platdata *plat = dev_get_uclass_platdata(dev); struct video_priv *uc_priv = dev_get_uclass_priv(dev); const void *blob = gd->fdt_blob; const int node = dev_of_offset(dev); const char *format; fdt_addr_t base; fdt_size_t size; base = fdtdec_get_addr_size_auto_parent(blob, dev_of_offset(dev->parent), node, "reg", 0, &size, false); if (base == FDT_ADDR_T_NONE) { debug("%s: Failed to decode memory region\n", __func__); return -EINVAL; } debug("%s: base=%llx, size=%llu\n", __func__, base, size); /* * TODO is there some way to reserve the framebuffer * region so it isn't clobbered? */ plat->base = base; plat->size = size; video_set_flush_dcache(dev, true); debug("%s: Query resolution...\n", __func__); uc_priv->xsize = fdtdec_get_uint(blob, node, "width", 0); uc_priv->ysize = fdtdec_get_uint(blob, node, "height", 0); uc_priv->rot = 0; format = fdt_getprop(blob, node, "format", NULL); debug("%s: %dx%d@%s\n", __func__, uc_priv->xsize, uc_priv->ysize, format); if (strcmp(format, "r5g6b5") == 0) { uc_priv->bpix = VIDEO_BPP16; } else if (strcmp(format, "a8b8g8r8") == 0) { uc_priv->bpix = VIDEO_BPP32; } else { printf("%s: invalid format: %s\n", __func__, format); return -EINVAL; } return 0; }
fdt_addr_t fdtdec_get_addr_size_auto_noparent(const void *blob, int node, const char *prop_name, int index, fdt_size_t *sizep) { int parent; debug("%s: ", __func__); parent = fdt_parent_offset(blob, node); if (parent < 0) { debug("(no parent found)\n"); return FDT_ADDR_T_NONE; } return fdtdec_get_addr_size_auto_parent(blob, parent, node, prop_name, index, sizep); }