1 files changed, 124 insertions, 0 deletions

diff --git a/drivers/net/wireless/rt2x00/rt2x00firmware.c b/drivers/net/wireless/rt2x00/rt2x00firmware.c
new file mode 100644
index 000000000000..236025f8b90f
--- /dev/null
+++ b/drivers/net/wireless/rt2x00/rt2x00firmware.c
@@ -0,0 +1,124 @@
+/*
+        Copyright (C) 2004 - 2007 rt2x00 SourceForge Project
+        <http://rt2x00.serialmonkey.com>
+
+        This program is free software; you can redistribute it and/or modify
+        it under the terms of the GNU General Public License as published by
+        the Free Software Foundation; either version 2 of the License, or
+        (at your option) any later version.
+
+        This program is distributed in the hope that it will be useful,
+        but WITHOUT ANY WARRANTY; without even the implied warranty of
+        MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+        GNU General Public License for more details.
+
+        You should have received a copy of the GNU General Public License
+        along with this program; if not, write to the
+        Free Software Foundation, Inc.,
+        59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
+ */
+
+/*
+        Module: rt2x00lib
+        Abstract: rt2x00 firmware loading routines.
+ */
+
+/*
+ * Set enviroment defines for rt2x00.h
+ */
+#define DRV_NAME "rt2x00lib"
+
+#include <linux/crc-itu-t.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+
+#include "rt2x00.h"
+#include "rt2x00lib.h"
+
+static int rt2x00lib_request_firmware(struct rt2x00_dev *rt2x00dev)
+{
+        struct device *device = wiphy_dev(rt2x00dev->hw->wiphy);
+        const struct firmware *fw;
+        char *fw_name;
+        int retval;
+        u16 crc;
+        u16 tmp;
+
+        /*
+         * Read correct firmware from harddisk.
+         */
+        fw_name = rt2x00dev->ops->lib->get_firmware_name(rt2x00dev);
+        if (!fw_name) {
+                ERROR(rt2x00dev,
+                      "Invalid firmware filename.\n"
+                      "Please file bug report to %s.\n", DRV_PROJECT);
+                return -EINVAL;
+        }
+
+        INFO(rt2x00dev, "Loading firmware file '%s'.\n", fw_name);
+
+        retval = request_firmware(&fw, fw_name, device);
+        if (retval) {
+                ERROR(rt2x00dev, "Failed to request Firmware.\n");
+                return retval;
+        }
+
+        if (!fw || !fw->size || !fw->data) {
+                ERROR(rt2x00dev, "Failed to read Firmware.\n");
+                return -ENOENT;
+        }
+
+        /*
+         * Validate the firmware using 16 bit CRC.
+         * The last 2 bytes of the firmware are the CRC
+         * so substract those 2 bytes from the CRC checksum,
+         * and set those 2 bytes to 0 when calculating CRC.
+         */
+        tmp = 0;
+        crc = crc_itu_t(0, fw->data, fw->size - 2);
+        crc = crc_itu_t(crc, (u8 *)&tmp, 2);
+
+        if (crc != (fw->data[fw->size - 2] << 8 | fw->data[fw->size - 1])) {
+                ERROR(rt2x00dev, "Firmware CRC error.\n");
+                retval = -ENOENT;
+                goto exit;
+        }
+
+        INFO(rt2x00dev, "Firmware detected - version: %d.%d.\n",
+             fw->data[fw->size - 4], fw->data[fw->size - 3]);
+
+        rt2x00dev->fw = fw;
+
+        return 0;
+
+exit:
+        release_firmware(fw);
+
+        return retval;
+}
+
+int rt2x00lib_load_firmware(struct rt2x00_dev *rt2x00dev)
+{
+        int retval;
+
+        if (!rt2x00dev->fw) {
+                retval = rt2x00lib_request_firmware(rt2x00dev);
+                if (retval)
+                        return retval;
+        }
+
+        /*
+         * Send firmware to the device.
+         */
+        retval = rt2x00dev->ops->lib->load_firmware(rt2x00dev,
+                                                    rt2x00dev->fw->data,
+                                                    rt2x00dev->fw->size);
+        return retval;
+}
+
+void rt2x00lib_free_firmware(struct rt2x00_dev *rt2x00dev)
+{
+        release_firmware(rt2x00dev->fw);
+        rt2x00dev->fw = NULL;
+}
+