kernel: add GS110TPPV1 support to mtdsplit_uimage
[openwrt/staging/chunkeey.git] / target / linux / generic / files / drivers / mtd / mtdsplit / mtdsplit_uimage.c
index 091403ae9186baa1827e942bf3948783aba04a4f..57d8b9f420d769712493cd6579875cc7d8f52ec3 100644 (file)
@@ -245,23 +245,20 @@ mtdsplit_uimage_parse_generic(struct mtd_info *master,
                                      uimage_verify_default);
 }
 
-#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 9, 0)
 static const struct of_device_id mtdsplit_uimage_of_match_table[] = {
        { .compatible = "denx,uimage" },
        {},
 };
-#endif
 
 static struct mtd_part_parser uimage_generic_parser = {
        .owner = THIS_MODULE,
        .name = "uimage-fw",
-#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 9, 0)
        .of_match_table = mtdsplit_uimage_of_match_table,
-#endif
        .parse_fn = mtdsplit_uimage_parse_generic,
        .type = MTD_PARSER_TYPE_FIRMWARE,
 };
 
+#define FW_MAGIC_GS110TPPV1    0x4e474520
 #define FW_MAGIC_WNR2000V1     0x32303031
 #define FW_MAGIC_WNR2000V3     0x32303033
 #define FW_MAGIC_WNR2000V4     0x32303034
@@ -279,6 +276,10 @@ static ssize_t uimage_verify_wndr3700(u_char *buf, size_t len, int *extralen)
        uint8_t expected_type = IH_TYPE_FILESYSTEM;
 
        switch (be32_to_cpu(header->ih_magic)) {
+       case FW_MAGIC_GS110TPPV1:
+       case FW_MAGIC_WNR2000V4:
+               expected_type = IH_TYPE_KERNEL;
+               break;
        case FW_MAGIC_WNR612V2:
        case FW_MAGIC_WNR1000V2:
        case FW_MAGIC_WNR1000V2_VC:
@@ -289,9 +290,6 @@ static ssize_t uimage_verify_wndr3700(u_char *buf, size_t len, int *extralen)
        case FW_MAGIC_WNDR3700V2:
        case FW_MAGIC_WPN824N:
                break;
-       case FW_MAGIC_WNR2000V4:
-               expected_type = IH_TYPE_KERNEL;
-               break;
        default:
                return -EINVAL;
        }
@@ -312,23 +310,68 @@ mtdsplit_uimage_parse_netgear(struct mtd_info *master,
                                      uimage_verify_wndr3700);
 }
 
-#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 9, 0)
 static const struct of_device_id mtdsplit_uimage_netgear_of_match_table[] = {
        { .compatible = "netgear,uimage" },
        {},
 };
-#endif
 
 static struct mtd_part_parser uimage_netgear_parser = {
        .owner = THIS_MODULE,
        .name = "netgear-fw",
-#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 9, 0)
        .of_match_table = mtdsplit_uimage_netgear_of_match_table,
-#endif
        .parse_fn = mtdsplit_uimage_parse_netgear,
        .type = MTD_PARSER_TYPE_FIRMWARE,
+
+};
+
+
+/**************************************************
+ * ALLNET
+ **************************************************/
+
+#define FW_MAGIC_SG8208M       0x00000006
+#define FW_MAGIC_SG8310PM      0x83000006
+
+static ssize_t uimage_verify_allnet(u_char *buf, size_t len, int *extralen)
+{
+       struct uimage_header *header = (struct uimage_header *)buf;
+
+       switch (be32_to_cpu(header->ih_magic)) {
+       case FW_MAGIC_SG8208M:
+       case FW_MAGIC_SG8310PM:
+               break;
+       default:
+               return -EINVAL;
+       }
+
+       if (header->ih_os != IH_OS_LINUX)
+               return -EINVAL;
+
+       return 0;
+}
+
+static int
+mtdsplit_uimage_parse_allnet(struct mtd_info *master,
+                             const struct mtd_partition **pparts,
+                             struct mtd_part_parser_data *data)
+{
+       return __mtdsplit_parse_uimage(master, pparts, data,
+                                     uimage_verify_allnet);
+}
+
+static const struct of_device_id mtdsplit_uimage_allnet_of_match_table[] = {
+       { .compatible = "allnet,uimage" },
+       {},
 };
 
+static struct mtd_part_parser uimage_allnet_parser = {
+       .owner = THIS_MODULE,
+       .name = "allnet-fw",
+       .of_match_table = mtdsplit_uimage_allnet_of_match_table,
+       .parse_fn = mtdsplit_uimage_parse_allnet,
+};
+
+
 /**************************************************
  * Edimax
  **************************************************/
@@ -364,19 +407,15 @@ mtdsplit_uimage_parse_edimax(struct mtd_info *master,
                                       uimage_find_edimax);
 }
 
-#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 9, 0)
 static const struct of_device_id mtdsplit_uimage_edimax_of_match_table[] = {
        { .compatible = "edimax,uimage" },
        {},
 };
-#endif
 
 static struct mtd_part_parser uimage_edimax_parser = {
        .owner = THIS_MODULE,
        .name = "edimax-fw",
-#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 9, 0)
        .of_match_table = mtdsplit_uimage_edimax_of_match_table,
-#endif
        .parse_fn = mtdsplit_uimage_parse_edimax,
        .type = MTD_PARSER_TYPE_FIRMWARE,
 };
@@ -407,21 +446,106 @@ mtdsplit_uimage_parse_fonfxc(struct mtd_info *master,
                                       uimage_find_fonfxc);
 }
 
-#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 9, 0)
 static const struct of_device_id mtdsplit_uimage_fonfxc_of_match_table[] = {
        { .compatible = "fonfxc,uimage" },
        {},
 };
-#endif
 
 static struct mtd_part_parser uimage_fonfxc_parser = {
        .owner = THIS_MODULE,
        .name = "fonfxc-fw",
-#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 9, 0)
        .of_match_table = mtdsplit_uimage_fonfxc_of_match_table,
-#endif
        .parse_fn = mtdsplit_uimage_parse_fonfxc,
-       .type = MTD_PARSER_TYPE_FIRMWARE,
+};
+
+/**************************************************
+ * SGE (T&W) Shenzhen Gongjin Electronics
+ **************************************************/
+
+#define SGE_PAD_LEN            96
+
+static ssize_t uimage_find_sge(u_char *buf, size_t len, int *extralen)
+{
+       if (uimage_verify_default(buf, len, extralen) < 0)
+               return -EINVAL;
+
+       *extralen = SGE_PAD_LEN;
+
+       return 0;
+}
+
+static int
+mtdsplit_uimage_parse_sge(struct mtd_info *master,
+                             const struct mtd_partition **pparts,
+                             struct mtd_part_parser_data *data)
+{
+       return __mtdsplit_parse_uimage(master, pparts, data,
+                                      uimage_find_sge);
+}
+
+static const struct of_device_id mtdsplit_uimage_sge_of_match_table[] = {
+       { .compatible = "sge,uimage" },
+       {},
+};
+
+static struct mtd_part_parser uimage_sge_parser = {
+       .owner = THIS_MODULE,
+       .name = "sge-fw",
+       .of_match_table = mtdsplit_uimage_sge_of_match_table,
+       .parse_fn = mtdsplit_uimage_parse_sge,
+};
+
+/**************************************************
+ * OKLI (OpenWrt Kernel Loader Image)
+ **************************************************/
+
+#define IH_MAGIC_OKLI  0x4f4b4c49
+
+static ssize_t uimage_verify_okli(u_char *buf, size_t len, int *extralen)
+{
+       struct uimage_header *header = (struct uimage_header *)buf;
+
+       /* default sanity checks */
+       if (be32_to_cpu(header->ih_magic) != IH_MAGIC_OKLI) {
+               pr_debug("invalid uImage magic: %08x\n",
+                        be32_to_cpu(header->ih_magic));
+               return -EINVAL;
+       }
+
+       if (header->ih_os != IH_OS_LINUX) {
+               pr_debug("invalid uImage OS: %08x\n",
+                        be32_to_cpu(header->ih_os));
+               return -EINVAL;
+       }
+
+       if (header->ih_type != IH_TYPE_KERNEL) {
+               pr_debug("invalid uImage type: %08x\n",
+                        be32_to_cpu(header->ih_type));
+               return -EINVAL;
+       }
+
+       return 0;
+}
+
+static int
+mtdsplit_uimage_parse_okli(struct mtd_info *master,
+                             const struct mtd_partition **pparts,
+                             struct mtd_part_parser_data *data)
+{
+       return __mtdsplit_parse_uimage(master, pparts, data,
+                                     uimage_verify_okli);
+}
+
+static const struct of_device_id mtdsplit_uimage_okli_of_match_table[] = {
+       { .compatible = "openwrt,okli" },
+       {},
+};
+
+static struct mtd_part_parser uimage_okli_parser = {
+       .owner = THIS_MODULE,
+       .name = "okli-fw",
+       .of_match_table = mtdsplit_uimage_okli_of_match_table,
+       .parse_fn = mtdsplit_uimage_parse_okli,
 };
 
 /**************************************************
@@ -432,8 +556,11 @@ static int __init mtdsplit_uimage_init(void)
 {
        register_mtd_parser(&uimage_generic_parser);
        register_mtd_parser(&uimage_netgear_parser);
+       register_mtd_parser(&uimage_allnet_parser);
        register_mtd_parser(&uimage_edimax_parser);
        register_mtd_parser(&uimage_fonfxc_parser);
+       register_mtd_parser(&uimage_sge_parser);
+       register_mtd_parser(&uimage_okli_parser);
 
        return 0;
 }