X-Git-Url: https://git.kernelconcepts.de/?p=karo-tx-uboot.git;a=blobdiff_plain;f=board%2Fkaro%2Fcommon%2Ffdt.c;h=d43a1170fc27a27748b55eadb131dcc7ec8df03d;hp=192e68816a4db9522e19ace6d55bbc420b5878e9;hb=18291c7ea879bae3af53a65eac4e5c81e53ad662;hpb=3079b5c39e833a8fdd2b8fbe5ec660683df2c8ac diff --git a/board/karo/common/fdt.c b/board/karo/common/fdt.c index 192e68816a..d43a1170fc 100644 --- a/board/karo/common/fdt.c +++ b/board/karo/common/fdt.c @@ -1,5 +1,5 @@ /* - * (C) Copyright 2012,2013 Lothar Waßmann + * (C) Copyright 2012-2014 Lothar Waßmann * * See file CREDITS for list of people who contributed to this * project. @@ -20,9 +20,11 @@ #include #include #include +#include #include #include #include +#include #include "karo.h" @@ -36,7 +38,6 @@ DECLARE_GLOBAL_DATA_PTR; static void karo_set_fdtsize(void *fdt) { - char fdt_size[9]; size_t fdtsize = getenv_ulong("fdtsize", 16, 0); if (fdtsize == fdt_totalsize(fdt)) { @@ -44,9 +45,39 @@ static void karo_set_fdtsize(void *fdt) } debug("FDT size changed from %u to %u\n", fdtsize, fdt_totalsize(fdt)); + setenv_hex("fdtsize", fdt_totalsize(fdt)); +} + +static void *karo_fdt_load_dtb(void) +{ + int ret; + void *fdt; + + if (getenv("fdtaddr") == NULL) + setenv_hex("fdtaddr", CONFIG_SYS_FDT_ADDR); + fdt = (void *)getenv_ulong("fdtaddr", 16, CONFIG_SYS_FDT_ADDR); + + if (had_ctrlc()) { + printf("aborting DTB load\n"); + return NULL; + } + + /* clear FDT header in memory */ + memset(fdt, 0, 4); - snprintf(fdt_size, sizeof(fdt_size), "%08x", fdt_totalsize(fdt)); - setenv("fdtsize", fdt_size); + ret = karo_load_part("dtb", fdt, MAX_DTB_SIZE); + if (ret) { + printf("Failed to load dtb from flash: %d\n", ret); + return NULL; + } + + if (fdt_check_header(fdt)) { + debug("No valid DTB in flash\n"); + return NULL; + } + debug("Using DTB from flash\n"); + karo_set_fdtsize(fdt); + return fdt; } void karo_fdt_move_fdt(void) @@ -59,6 +90,8 @@ void karo_fdt_move_fdt(void) return; } + setenv("fdtsize", 0); + if (!fdt_addr) { fdt_addr = CONFIG_SYS_FDT_ADDR; printf("fdtaddr is not set; using default: %08lx\n", @@ -69,21 +102,28 @@ void karo_fdt_move_fdt(void) if (fdt == NULL) { fdt = (void *)gd->fdt_blob; if (fdt == NULL) { - printf("Compiled in FDT not found\n"); - return; +#ifdef CONFIG_OF_EMBED + printf("Compiled in FDT not found"); +#else + printf("No FDT found"); +#endif + printf("; creating empty DTB\n"); + fdt = (void *)fdt_addr; + fdt_create_empty_tree(fdt, 256); + } else { + printf("No DTB in flash; using default DTB\n"); } debug("Checking FDT header @ %p\n", fdt); if (fdt_check_header(fdt)) { printf("ERROR: No valid DTB found at %p\n", fdt); return; } - printf("No DTB in flash; using default DTB\n"); debug("Moving FDT from %p..%p to %08lx..%08lx\n", fdt, fdt + fdt_totalsize(fdt) - 1, fdt_addr, fdt_addr + fdt_totalsize(fdt) - 1); memmove((void *)fdt_addr, fdt, fdt_totalsize(fdt)); } - set_working_fdt_addr((void *)fdt_addr); + set_working_fdt_addr(fdt_addr); gd->fdt_blob = fdt; karo_set_fdtsize(fdt); } @@ -96,12 +136,13 @@ void karo_fdt_remove_node(void *blob, const char *node) debug("Removing node '%s' from DT\n", node); if (off < 0) { - printf("Could not find node '%s': %d\n", node, off); + printf("Could not find node '%s': %s\n", node, + fdt_strerror(off)); } else { ret = fdt_del_node(blob, off); if (ret) - printf("Failed to remove node '%s': %d\n", - node, ret); + printf("Failed to remove node '%s': %s\n", + node, fdt_strerror(ret)); } karo_set_fdtsize(blob); } @@ -112,7 +153,8 @@ void karo_fdt_enable_node(void *blob, const char *node, int enable) debug("%sabling node '%s'\n", enable ? "En" : "Dis", node); if (off < 0) { - printf("Could not find node '%s': %d\n", node, off); + printf("Could not find node '%s': %s\n", node, + fdt_strerror(off)); return; } fdt_set_node_status(blob, off, @@ -121,58 +163,78 @@ void karo_fdt_enable_node(void *blob, const char *node, int enable) karo_set_fdtsize(blob); } -static const char *karo_touchpanels[] = { - "ti,tsc2007", - "edt,edt-ft5x06", -#ifdef CONFIG_MX28 - "fsl,imx28-lradc", -#endif -}; - static void fdt_disable_tp_node(void *blob, const char *name) { int offs = fdt_node_offset_by_compatible(blob, -1, name); - if (offs < 0) { - debug("node '%s' not found: %d\n", name, offs); - return; + while (offs >= 0) { + debug("Disabling node '%s'\n", name); + fdt_set_node_status(blob, offs, FDT_STATUS_DISABLED, 0); + offs = fdt_node_offset_by_compatible(blob, offs, name); } - - debug("Disabling node '%s'\n", name); - fdt_set_node_status(blob, offs, FDT_STATUS_DISABLED, 0); } -void karo_fdt_fixup_touchpanel(void *blob) +void karo_fdt_fixup_touchpanel(void *blob, const char *panels[], + size_t num_panels) { int i; const char *model = getenv("touchpanel"); - for (i = 0; i < ARRAY_SIZE(karo_touchpanels); i++) { - const char *tp = karo_touchpanels[i]; - - if (model != NULL && strcmp(model, tp) == 0) - continue; + for (i = 0; i < num_panels; i++) { + const char *tp = panels[i]; if (model != NULL) { if (strcmp(model, tp) == 0) continue; - tp = strchr(tp, ','); - if (tp != NULL && *tp != '\0' && strcmp(model, tp + 1) == 0) + while (tp != NULL) { + if (*tp != '\0' && strcmp(model, tp + 1) == 0) + break; + tp = strpbrk(tp + 1, ",-"); + } + if (tp != NULL) continue; } - fdt_disable_tp_node(blob, karo_touchpanels[i]); - karo_set_fdtsize(blob); + fdt_disable_tp_node(blob, panels[i]); } + karo_set_fdtsize(blob); } -void karo_fdt_fixup_usb_otg(void *blob, const char *node, const char *phy) +static int karo_fdt_disable_node_phandle(void *blob, const char *parent, + const char *name) +{ + const uint32_t *ph; + int off; + + off = fdt_path_offset(blob, parent); + if (off < 0) { + printf("Failed to find node '%s'\n", parent); + return off; + } + + ph = fdt_getprop(blob, off, name, NULL); + if (ph == NULL) { + debug("Failed to find '%s' phandle in node '%s'\n", name, + fdt_get_name(blob, off, NULL)); + return -FDT_ERR_NOTFOUND; + } + + off = fdt_node_offset_by_phandle(blob, fdt32_to_cpu(*ph)); + if (off <= 0) { + printf("Failed to find '%s' node via phandle %04x\n", + name, fdt32_to_cpu(*ph)); + return -FDT_ERR_NOTFOUND; + } + return fdt_set_node_status(blob, off, FDT_STATUS_DISABLED, 0); +} + +void karo_fdt_fixup_usb_otg(void *blob, const char *node, const char *phy, + const char *phy_supply) { const char *otg_mode = getenv("otg_mode"); int off; int ret; - const uint32_t *ph; int disable_otg = 0; - int disable_phy_pins = 1; + int disable_phy_pins = 0; debug("OTG mode is '%s'\n", otg_mode ? otg_mode : ""); @@ -182,19 +244,19 @@ void karo_fdt_fixup_usb_otg(void *blob, const char *node, const char *phy) return; } - if (otg_mode && (strcmp(otg_mode, "device") == 0 || - strcmp(otg_mode, "gadget") == 0)) { + if (otg_mode && (strcasecmp(otg_mode, "device") == 0 || + strcasecmp(otg_mode, "gadget") == 0)) { debug("Setting dr_mode to 'peripheral'\n"); ret = fdt_setprop_string(blob, off, "dr_mode", "peripheral"); - } else if (otg_mode && strcmp(otg_mode, "host") == 0) { + disable_phy_pins = 1; + } else if (otg_mode && strcasecmp(otg_mode, "host") == 0) { debug("Setting dr_mode to 'host'\n"); ret = fdt_setprop_string(blob, off, "dr_mode", "host"); - disable_phy_pins = 0; - } else if (otg_mode && strcmp(otg_mode, "otg") == 0) { - debug("Setting dr_mode to 'host'\n"); + } else if (otg_mode && strcasecmp(otg_mode, "otg") == 0) { + debug("Setting dr_mode to 'otg'\n"); ret = fdt_setprop_string(blob, off, "dr_mode", "otg"); } else { - if (otg_mode && strcmp(otg_mode, "none") != 0) + if (otg_mode && strcasecmp(otg_mode, "none") != 0) printf("Invalid 'otg_mode' setting '%s'; disabling usbotg port\n", otg_mode); disable_otg = 1; @@ -204,69 +266,179 @@ void karo_fdt_fixup_usb_otg(void *blob, const char *node, const char *phy) if ((!disable_phy_pins && !disable_otg) || ret) goto out; - if (disable_otg) { - ret = fdt_set_node_status(blob, off, FDT_STATUS_DISABLED, 0); - if (ret) - goto out; - } + ret = karo_fdt_disable_node_phandle(blob, node, phy_supply); + if (ret && ret == -FDT_ERR_NOTFOUND) { + const uint32_t *ph; - ph = fdt_getprop(blob, off, phy, NULL); - if (ph == NULL) { - printf("Failed to find '%s' phandle in node '%s'\n", phy, - fdt_get_name(blob, off, NULL)); - goto out; + ph = fdt_getprop(blob, off, phy, NULL); + if (ph == NULL) { + printf("Failed to find '%s' phandle in node '%s'\n", + phy, node); + ret = -FDT_ERR_NOTFOUND; + goto out; + } + off = fdt_node_offset_by_phandle(blob, fdt32_to_cpu(*ph)); + if (off < 0) { + printf("Failed to find '%s' node via phandle %04x\n", + phy, fdt32_to_cpu(*ph)); + ret = off; + goto out; + } + ph = fdt_getprop(blob, off, phy_supply, NULL); + if (ph == NULL) { + debug("Failed to find '%s' phandle in node '%s'\n", + phy_supply, fdt_get_name(blob, off, NULL)); + ret = -FDT_ERR_NOTFOUND; + goto disable_otg; + } + ret = fdt_node_offset_by_phandle(blob, fdt32_to_cpu(*ph)); + if (ret > 0) { + debug("Disabling node %s via phandle %s:%s\n", + fdt_get_name(blob, ret, NULL), + fdt_get_name(blob, off, NULL), phy_supply); + ret = fdt_set_node_status(blob, ret, + FDT_STATUS_DISABLED, 0); + } } - - off = fdt_node_offset_by_phandle(blob, fdt32_to_cpu(*ph)); - if (off <= 0) { - printf("Failed to find '%s' node via phandle %04x\n", - phy, fdt32_to_cpu(*ph)); + if (ret && ret != -FDT_ERR_NOTFOUND) goto out; - } +disable_otg: if (disable_otg) { - debug("Disabling usbphy\n"); + debug("Disabling '%s'\n", fdt_get_name(blob, off, NULL)); ret = fdt_set_node_status(blob, off, FDT_STATUS_DISABLED, 0); + if (ret > 0) + ret = karo_fdt_disable_node_phandle(blob, node, phy); + } else if (disable_phy_pins) { + debug("Removing '%s' from node '%s'\n", phy_supply, + fdt_get_name(blob, off, NULL)); + ret = fdt_delprop(blob, off, phy_supply); } + out: - if (ret) - printf("Failed to update usbotg: %d\n", ret); + if (ret && ret != -FDT_ERR_NOTFOUND) + printf("Failed to update usbotg: %s\n", fdt_strerror(ret)); else debug("node '%s' updated\n", node); karo_set_fdtsize(blob); } -void karo_fdt_del_prop(void *blob, const char *compat, phys_addr_t offs, - const char *prop) +static inline int karo_fdt_flexcan_enabled(void *blob) { - int ret; - int offset; - const uint32_t *phandle; - uint32_t ph = 0; - - offset = fdt_node_offset_by_compat_reg(blob, compat, offs); - if (offset <= 0) - return; - - phandle = fdt_getprop(blob, offset, prop, NULL); - if (phandle) { - ph = fdt32_to_cpu(*phandle); + static const char *can_ifs[] = { + "can0", + "can1", + }; + size_t i; + + for (i = 0; i < ARRAY_SIZE(can_ifs); i++) { + const char *status; + int off = fdt_path_offset(blob, can_ifs[i]); + + if (off < 0) { + debug("node '%s' not found\n", can_ifs[i]); + continue; + } + status = fdt_getprop(blob, off, "status", NULL); + if (status && strcmp(status, "okay") == 0) { + debug("%s is enabled\n", can_ifs[i]); + return 1; + } } + debug("can driver is disabled\n"); + return 0; +} - debug("Removing property '%s' from node %s@%08lx\n", prop, compat, offs); - ret = fdt_delprop(blob, offset, prop); - if (ret == 0) - karo_set_fdtsize(blob); +static inline void karo_fdt_set_lcd_pins(void *blob, const char *name) +{ + int off = fdt_path_offset(blob, name); + u32 ph; + const struct fdt_property *pc; + int len; + if (off < 0) + return; + + ph = fdt_create_phandle(blob, off); if (!ph) return; - offset = fdt_node_offset_by_phandle(blob, ph); - if (offset <= 0) + off = fdt_path_offset(blob, "display"); + if (off < 0) + return; + + pc = fdt_get_property(blob, off, "pinctrl-0", &len); + if (!pc || len < sizeof(ph)) return; - debug("Removing node @ %08x\n", offset); - fdt_del_node(blob, offset); + memcpy((void *)pc->data, &ph, sizeof(ph)); + fdt_setprop_cell(blob, off, "pinctrl-0", ph); +} + +void karo_fdt_fixup_flexcan(void *blob, int xcvr_present) +{ + int ret; + const char *xcvr_status = "disabled"; + const char *otg_mode = getenv("otg_mode"); + + if (xcvr_present) { + if (karo_fdt_flexcan_enabled(blob)) { + if (!is_lvds()) { + debug("Changing LCD to use 23bits only\n"); + karo_fdt_set_lcd_pins(blob, "lcdif_23bit_pins_a"); + xcvr_status = NULL; + } + } else if (!is_lvds()) { + debug("Changing LCD to use 24bits\n"); + karo_fdt_set_lcd_pins(blob, "lcdif_24bit_pins_a"); + } + } else { + int off = fdt_path_offset(blob, "can0"); + + if (off >= 0) + fdt_delprop(blob, off, "xceiver-supply"); + off = fdt_path_offset(blob, "can1"); + if (off >= 0) + fdt_delprop(blob, off, "xceiver-supply"); + if (!is_lvds()) + karo_fdt_set_lcd_pins(blob, "lcdif_24bit_pins_a"); + } + + if (otg_mode && strcasecmp(otg_mode, "host") == 0) + karo_fdt_enable_node(blob, "can1", 0); + + if (xcvr_status) { + debug("Disabling CAN XCVR\n"); + ret = fdt_find_and_setprop(blob, "reg_can_xcvr", "status", + xcvr_status, strlen(xcvr_status) + 1, 1); + if (ret) + printf("Failed to disable CAN transceiver switch: %s\n", + fdt_strerror(ret)); + } +} + +void karo_fdt_del_prop(void *blob, const char *compat, u32 offs, + const char *propname) +{ + int offset = -1; + const fdt32_t *reg = NULL; + + while (1) { + offset = fdt_node_offset_by_compatible(blob, offset, compat); + if (offset <= 0) + return; + + reg = fdt_getprop(blob, offset, "reg", NULL); + if (reg == NULL) + return; + + if (fdt32_to_cpu(*reg) == offs) + break; + } + debug("Removing property '%s' from node %s@%x\n", + propname, compat, offs); + fdt_delprop(blob, offset, propname); + karo_set_fdtsize(blob); } @@ -319,15 +491,15 @@ static int fdt_init_fb_mode(const void *blob, int off, struct fb_videomode *fb_m prop = fdt_getprop(blob, off, "vsync-active", NULL); if (prop) fb_mode->sync |= *prop ? FB_SYNC_VERT_HIGH_ACT : 0; -#if 0 + prop = fdt_getprop(blob, off, "de-active", NULL); if (prop) - fb_mode->sync |= *prop ? FB_SYNC_DATA_ENABLE_HIGH_ACT : 0; + fb_mode->sync |= *prop ? 0 : FB_SYNC_OE_LOW_ACT; prop = fdt_getprop(blob, off, "pixelclk-active", NULL); if (prop) - fb_mode->sync |= *prop ? FB_SYNC_DOTCLK_FALLING_ACT : 0; -#endif + fb_mode->sync |= *prop ? 0 : FB_SYNC_CLK_LAT_FALL; + return 0; } @@ -336,16 +508,13 @@ static int fdt_update_native_fb_mode(void *blob, int off) int ret; uint32_t ph; + ret = fdt_increase_size(blob, 64); + if (ret) { + printf("Warning: Failed to increase FDT size: %s\n", + fdt_strerror(ret)); + } debug("Creating phandle at offset %d\n", off); ph = fdt_create_phandle(blob, off); - if (!ph) { - ret = fdt_increase_size(blob, 512); - if (ret) { - printf("Failed to increase FDT size: %d\n", ret); - return ret; - } - ph = fdt_create_phandle(blob, off); - } if (!ph) { printf("Failed to create phandle for video timing\n"); return -ENOMEM; @@ -359,7 +528,8 @@ static int fdt_update_native_fb_mode(void *blob, int off) debug("parent offset=%06x\n", off); ret = fdt_setprop_cell(blob, off, "native-mode", ph); if (ret) - printf("Failed to set property 'native-mode': %d\n", ret); + printf("Failed to set property 'native-mode': %s\n", + fdt_strerror(ret)); karo_set_fdtsize(blob); return ret; } @@ -370,13 +540,15 @@ static int karo_fdt_find_video_timings(void *blob) const char *subnode = "display-timings"; if (off < 0) { - debug("Could not find node 'display' in FDT: %d\n", off); + debug("Could not find node 'display' in FDT: %s\n", + fdt_strerror(off)); return off; } off = fdt_subnode_offset(blob, off, subnode); if (off < 0) { - debug("Could not find node '%s' in FDT: %d\n", subnode, off); + debug("Could not find node '%s' in FDT: %s\n", subnode, + fdt_strerror(off)); } return off; } @@ -397,10 +569,10 @@ int karo_fdt_get_fb_mode(void *blob, const char *name, struct fb_videomode *fb_m if (d < 1) return -EINVAL; if (d > 2) { - debug("Skipping node @ %04x %s depth %d\n", off, fdt_get_name(blob, off, NULL), d); + debug("Skipping node @ %04x %s depth %d\n", off, + fdt_get_name(blob, off, NULL), d); continue; } - debug("parsing subnode @ %04x %s depth %d\n", off, fdt_get_name(blob, off, NULL), d); n = fdt_getprop(blob, off, "panel-name", &len); if (!n) { @@ -425,8 +597,7 @@ int karo_fdt_get_fb_mode(void *blob, const char *name, struct fb_videomode *fb_m } } if (off > 0) { - fdt_init_fb_mode(blob, off, fb_mode); - return fdt_update_native_fb_mode(blob, off); + return fdt_init_fb_mode(blob, off, fb_mode); } return -EINVAL; } @@ -435,7 +606,8 @@ int karo_fdt_get_fb_mode(void *blob, const char *name, struct fb_videomode *fb_m int ret; \ ret = fdt_setprop_u32(blob, off, n, v); \ if (ret) { \ - printf("Failed to set property %s: %d\n", name, ret); \ + printf("Failed to set property %s: %s\n", name, \ + fdt_strerror(ret)); \ } \ ret; \ }) @@ -455,25 +627,26 @@ int karo_fdt_create_fb_mode(void *blob, const char *name, ret = fdt_increase_size(blob, 512); if (ret) { - printf("Failed to increase FDT size: %d\n", ret); + printf("Failed to increase FDT size: %s\n", fdt_strerror(ret)); return ret; } - printf("node '%s' offset=%d\n", "display", off); ret = fdt_subnode_offset(blob, off, subnode); if (ret < 0) { - debug("Could not find node '%s' in FDT: %d\n", subnode, ret); + debug("Could not find node '%s' in FDT: %s\n", subnode, + fdt_strerror(ret)); ret = fdt_add_subnode(blob, off, subnode); if (ret < 0) { - printf("Failed to add %s subnode: %d\n", subnode, ret); + printf("Failed to add %s subnode: %s\n", subnode, + fdt_strerror(ret)); return ret; } } - printf("node '%s' offset=%d\n", subnode, ret); ret = fdt_add_subnode(blob, ret, name); if (ret < 0) { - printf("Failed to add %s subnode: %d\n", name, ret); + printf("Failed to add %s subnode: %s\n", name, + fdt_strerror(ret)); return ret; } off = ret; @@ -514,17 +687,12 @@ int karo_fdt_create_fb_mode(void *blob, const char *name, fb_mode->sync & FB_SYNC_VERT_HIGH_ACT ? 1 : 0); if (ret) goto out; - - /* TOTO: make these configurable */ - ret = SET_FB_PROP("de-active", 1); - if (ret) - goto out; - ret = SET_FB_PROP("pixelclk-active", 1); + ret = SET_FB_PROP("de-active", + !(fb_mode->sync & FB_SYNC_OE_LOW_ACT)); if (ret) goto out; - - return fdt_update_native_fb_mode(blob, off); - + ret = SET_FB_PROP("pixelclk-active", + !(fb_mode->sync & FB_SYNC_CLK_LAT_FALL)); out: karo_set_fdtsize(blob); return ret; @@ -539,22 +707,18 @@ int karo_fdt_update_fb_mode(void *blob, const char *name) return off; if (name == NULL) { - int parent = fdt_parent_offset(blob, off); int ret; - if (parent < 0) { - printf("Failed to find parent of node '%s'\n", - fdt_get_name(blob, off, NULL)); - return parent; - } - debug("parent offset=%06x\n", parent); - ret = fdt_set_node_status(blob, parent, FDT_STATUS_DISABLED, 0); + debug("Disabling node '%s' at %03x\n", + fdt_get_name(blob, off, NULL), off); + ret = fdt_set_node_status(blob, off, FDT_STATUS_DISABLED, 0); return ret; } off = fdt_subnode_offset(blob, off, subnode); if (off < 0) { - debug("Could not find node '%s' in FDT: %d\n", subnode, off); + debug("Could not find node '%s' in FDT: %s\n", subnode, + fdt_strerror(off)); return off; } while (off > 0) { @@ -567,10 +731,10 @@ int karo_fdt_update_fb_mode(void *blob, const char *name) if (d < 1) return -EINVAL; if (d > 2) { - debug("Skipping node @ %04x %s depth %d\n", off, fdt_get_name(blob, off, NULL), d); + debug("Skipping node @ %04x %s depth %d\n", off, + fdt_get_name(blob, off, NULL), d); continue; } - debug("parsing subnode @ %04x %s depth %d\n", off, fdt_get_name(blob, off, NULL), d); n = fdt_getprop(blob, off, "panel-name", &len); if (!n) { @@ -599,75 +763,94 @@ int karo_fdt_update_fb_mode(void *blob, const char *name) return off; } -static int karo_load_part(const char *part, void *addr, size_t len) +#ifdef CONFIG_SYS_LVDS_IF +int karo_fdt_get_lcd_bus_width(const void *blob, int default_width) { - int ret; - struct mtd_device *dev; - struct part_info *part_info; - u8 part_num; - size_t actual; - - debug("Initializing mtd_parts\n"); - ret = mtdparts_init(); - if (ret) - return ret; + int off = fdt_path_offset(blob, "display"); - debug("Trying to find NAND partition '%s'\n", part); - ret = find_dev_and_part(part, &dev, &part_num, - &part_info); - if (ret) { - printf("Failed to find flash partition '%s': %d\n", - part, ret); + if (off >= 0) { + const uint32_t *prop; - return ret; - } - debug("Found partition '%s': offset=%08x size=%08x\n", - part, part_info->offset, part_info->size); - if (part_info->size < len) { - printf("Warning: partition '%s' smaller than requested size: %u; truncating data to %u byte\n", - part, len, part_info->size); - len = part_info->size; + prop = fdt_getprop(blob, off, "fsl,data-width", NULL); + if (prop) + return fdt32_to_cpu(*prop); } - debug("Reading NAND partition '%s' to %p\n", part, addr); - ret = nand_read_skip_bad(&nand_info[0], part_info->offset, &len, - &actual, len, addr); - if (ret) { - printf("Failed to load partition '%s' to %p\n", part, addr); - return ret; - } - if (actual < len) - printf("Read only %u of %u bytes due to bad blocks\n", - actual, len); + return default_width; +} - debug("Read %u byte from partition '%s' @ offset %08x\n", - len, part, part_info->offset); - return 0; +int karo_fdt_get_lvds_mapping(const void *blob, int default_mapping) +{ + int off = fdt_path_offset(blob, "display"); + + if (off >= 0) { + const char *prop; + + prop = fdt_getprop(blob, off, "fsl,data-mapping", NULL); + if (prop) + return strcmp(prop, "jeida") == 0; + } + return default_mapping; } -void *karo_fdt_load_dtb(void) +u8 karo_fdt_get_lvds_channels(const void *blob) { - int ret; - void *fdt = (void *)getenv_ulong("fdtaddr", 16, CONFIG_SYS_FDT_ADDR); + static const char *lvds_chans[] = { + "lvds0", + "lvds1", + }; + u8 lvds_chan_mask = 0; + int i; - if (tstc()) { - debug("aborting DTB load\n"); - return NULL; + for (i = 0; i < ARRAY_SIZE(lvds_chans); i++) { + const char *status; + int off = fdt_path_offset(blob, lvds_chans[i]); + + if (off < 0) + continue; + + status = fdt_getprop(blob, off, "status", NULL); + if (status && strcmp(status, "okay") == 0) { + debug("%s is enabled\n", lvds_chans[i]); + lvds_chan_mask |= 1 << i; + } } + return lvds_chan_mask; +} +#endif - /* clear FDT header in memory */ - memset(fdt, 0, 4); +int karo_fdt_get_backlight_polarity(const void *blob) +{ +#ifdef CONFIG_SYS_LVDS_IF + const char *backlight_node = "/backlight0"; +#else + const char *backlight_node = "/backlight"; +#endif + int off = fdt_path_offset(blob, "backlight"); /* first try alias */ + const struct fdt_property *prop; + int len; - ret = karo_load_part("dtb", fdt, MAX_DTB_SIZE); - if (ret) { - printf("Failed to load dtb from flash: %d\n", ret); - return NULL; + if (off < 0) { + /* + * if no 'backlight' alias exists try finding '/backlight0' + * or '/backlight' depending on LVDS or not + */ + off = fdt_path_offset(blob, backlight_node); + if (off < 0) { + printf("%s node not found in DT\n", backlight_node); + return off; + } } - if (fdt_check_header(fdt)) { - debug("No valid DTB in flash\n"); - return NULL; + prop = fdt_get_property(blob, off, "pwms", &len); + if (!prop) + printf("'pwms' property not found\n"); + else + debug("'pwms' property has len %d\n", len); + + len /= sizeof(u32); + if (prop && len > 3) { + const u32 *data = (const u32 *)prop->data; + return fdt32_to_cpu(data[3]) == 0; } - debug("Using DTB from flash\n"); - karo_set_fdtsize(fdt); - return fdt; + return 0; }