ar71xx: routerboot: add support for extended radio data
authorGabor Juhos <juhosg@openwrt.org>
Tue, 7 Apr 2015 20:03:35 +0000 (20:03 +0000)
committerGabor Juhos <juhosg@openwrt.org>
Tue, 7 Apr 2015 20:03:35 +0000 (20:03 +0000)
On newer Mikrotik boards, the radio calibration data
is stored differently and uses LZO compression instead
of RLE.

Update the RouterBOOT helper code to support the new
format.

Signed-off-by: Gabor Juhos <juhosg@openwrt.org>
SVN-Revision: 45297

target/linux/ar71xx/files/arch/mips/ath79/routerboot.c
target/linux/ar71xx/files/arch/mips/ath79/routerboot.h
target/linux/ar71xx/mikrotik/config-default
target/linux/ar71xx/patches-3.18/610-MIPS-ath79-openwrt-machines.patch

index dbdec02..5853b15 100644 (file)
 #include <linux/errno.h>
 #include <linux/routerboot.h>
 #include <linux/rle.h>
+#include <linux/lzo.h>
 
 #include "routerboot.h"
 
 #define RB_BLOCK_SIZE          0x1000
 #define RB_ART_SIZE            0x10000
+#define RB_MAGIC_ERD           0x00455244      /* extended radio data */
 
 static struct rb_info rb_info;
 
@@ -63,6 +65,7 @@ routerboot_find_tag(u8 *buf, unsigned int buflen, u16 tag_id,
                    u8 **tag_data, u16 *tag_len)
 {
        uint32_t magic;
+       bool align = false;
        int ret;
 
        if (buflen < 4)
@@ -70,6 +73,9 @@ routerboot_find_tag(u8 *buf, unsigned int buflen, u16 tag_id,
 
        magic = get_u32(buf);
        switch (magic) {
+       case RB_MAGIC_ERD:
+               align = true;
+               /* fall trough */
        case RB_MAGIC_HARD:
                /* skip magic value */
                buf += 4;
@@ -121,6 +127,9 @@ routerboot_find_tag(u8 *buf, unsigned int buflen, u16 tag_id,
                        break;
                }
 
+               if (align)
+                       len = (len + 3) / 4;
+
                buf += len;
                buflen -= len;
        }
@@ -168,13 +177,16 @@ rb_get_hw_options(void)
        return get_u32(tag);
 }
 
-__init void *
-rb_get_wlan_data(void)
+static void * __init
+__rb_get_wlan_data(u16 id)
 {
        u16 tag_len;
        u8 *tag;
        void *buf;
        int err;
+       u32 magic;
+       size_t src_done;
+       size_t dst_done;
 
        err = rb_find_hard_cfg_tag(RB_ID_WLAN_DATA, &tag, &tag_len);
        if (err) {
@@ -188,11 +200,38 @@ rb_get_wlan_data(void)
                goto err;
        }
 
-       err = rle_decode((char *) tag, tag_len, buf, RB_ART_SIZE,
-                        NULL, NULL);
-       if (err) {
-               pr_err("unable to decode calibration data\n");
-               goto err_free;
+       magic = get_u32(tag);
+       if (magic == RB_MAGIC_ERD) {
+               u8 *erd_data;
+               u16 erd_len;
+
+               if (id == 0)
+                       goto err_free;
+
+               err = routerboot_find_tag(tag, tag_len, id,
+                                         &erd_data, &erd_len);
+               if (err) {
+                       pr_err("no ERD data found for id %u\n", id);
+                       goto err_free;
+               }
+
+               dst_done = RB_ART_SIZE;
+               err = lzo1x_decompress_safe(erd_data, erd_len, buf, &dst_done);
+               if (err) {
+                       pr_err("unable to decompress calibration data %d\n",
+                              err);
+                       goto err_free;
+               }
+       } else {
+               if (id != 0)
+                       goto err_free;
+
+               err = rle_decode((char *) tag, tag_len, buf, RB_ART_SIZE,
+                                &src_done, &dst_done);
+               if (err) {
+                       pr_err("unable to decode calibration data\n");
+                       goto err_free;
+               }
        }
 
        return buf;
@@ -203,6 +242,18 @@ err:
        return NULL;
 }
 
+__init void *
+rb_get_wlan_data(void)
+{
+       return __rb_get_wlan_data(0);
+}
+
+__init void *
+rb_get_ext_wlan_data(u16 id)
+{
+       return __rb_get_wlan_data(id);
+}
+
 __init const struct rb_info *
 rb_init_info(void *data, unsigned int size)
 {
index 6ec296a..c1d7fb9 100644 (file)
@@ -24,6 +24,7 @@ struct rb_info {
 #ifdef CONFIG_ATH79_ROUTERBOOT
 const struct rb_info *rb_init_info(void *data, unsigned int size);
 void *rb_get_wlan_data(void);
+void *rb_get_ext_wlan_data(u16 id);
 
 int routerboot_find_tag(u8 *buf, unsigned int buflen, u16 tag_id,
                        u8 **tag_data, u16 *tag_len);
@@ -40,6 +41,11 @@ static inline void *rb_get_wlan_data(void)
        return NULL;
 }
 
+static inline void *rb_get_wlan_data(u16 id)
+{
+       return NULL;
+}
+
 static inline int
 routerboot_find_tag(u8 *buf, unsigned int buflen, u16 tag_id,
                    u8 **tag_data, u16 *tag_len)
index c939a95..58cc344 100644 (file)
@@ -124,6 +124,7 @@ CONFIG_GPIO_74X164=y
 CONFIG_GPIO_LATCH=y
 # CONFIG_JFFS2_FS is not set
 CONFIG_LEDS_RB750=y
+CONFIG_LZO_DECOMPRESS=y
 CONFIG_MDIO_BITBANG=y
 CONFIG_MDIO_GPIO=y
 # CONFIG_MTD_CFI is not set
index 3555de3..2aca064 100644 (file)
        def_bool n
  
  config ATH79_DEV_GPIO_BUTTONS
-@@ -154,6 +1226,10 @@ config ATH79_PCI_ATH9K_FIXUP
+@@ -154,6 +1226,11 @@ config ATH79_PCI_ATH9K_FIXUP
        def_bool n
  
  config ATH79_ROUTERBOOT
 +      select RLE_DECOMPRESS
++      select LZO_DECOMPRESS
 +      def_bool n
 +
 +config PCI_AR724X