PageRenderTime 8ms CodeModel.GetById 1ms app.highlight 4ms RepoModel.GetById 1ms app.codeStats 0ms

/drivers/net/wireless/rt2x00/rt2x00firmware.c

http://github.com/mirrors/linux
C | 131 lines | 75 code | 21 blank | 35 comment | 9 complexity | d0edb7238119abcdeffcce5c0cca1626 MD5 | raw file
  1/*
  2	Copyright (C) 2004 - 2009 Ivo van Doorn <IvDoorn@gmail.com>
  3	Copyright (C) 2004 - 2009 Gertjan van Wingerde <gwingerde@gmail.com>
  4	<http://rt2x00.serialmonkey.com>
  5
  6	This program is free software; you can redistribute it and/or modify
  7	it under the terms of the GNU General Public License as published by
  8	the Free Software Foundation; either version 2 of the License, or
  9	(at your option) any later version.
 10
 11	This program is distributed in the hope that it will be useful,
 12	but WITHOUT ANY WARRANTY; without even the implied warranty of
 13	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 14	GNU General Public License for more details.
 15
 16	You should have received a copy of the GNU General Public License
 17	along with this program; if not, write to the
 18	Free Software Foundation, Inc.,
 19	59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
 20 */
 21
 22/*
 23	Module: rt2x00lib
 24	Abstract: rt2x00 firmware loading routines.
 25 */
 26
 27#include <linux/kernel.h>
 28#include <linux/module.h>
 29
 30#include "rt2x00.h"
 31#include "rt2x00lib.h"
 32
 33static int rt2x00lib_request_firmware(struct rt2x00_dev *rt2x00dev)
 34{
 35	struct device *device = wiphy_dev(rt2x00dev->hw->wiphy);
 36	const struct firmware *fw;
 37	char *fw_name;
 38	int retval;
 39
 40	/*
 41	 * Read correct firmware from harddisk.
 42	 */
 43	fw_name = rt2x00dev->ops->lib->get_firmware_name(rt2x00dev);
 44	if (!fw_name) {
 45		rt2x00_err(rt2x00dev,
 46			   "Invalid firmware filename\n"
 47			   "Please file bug report to %s\n", DRV_PROJECT);
 48		return -EINVAL;
 49	}
 50
 51	rt2x00_info(rt2x00dev, "Loading firmware file '%s'\n", fw_name);
 52
 53	retval = request_firmware(&fw, fw_name, device);
 54	if (retval) {
 55		rt2x00_err(rt2x00dev, "Failed to request Firmware\n");
 56		return retval;
 57	}
 58
 59	if (!fw || !fw->size || !fw->data) {
 60		rt2x00_err(rt2x00dev, "Failed to read Firmware\n");
 61		release_firmware(fw);
 62		return -ENOENT;
 63	}
 64
 65	rt2x00_info(rt2x00dev, "Firmware detected - version: %d.%d\n",
 66		    fw->data[fw->size - 4], fw->data[fw->size - 3]);
 67	snprintf(rt2x00dev->hw->wiphy->fw_version,
 68			sizeof(rt2x00dev->hw->wiphy->fw_version), "%d.%d",
 69			fw->data[fw->size - 4], fw->data[fw->size - 3]);
 70
 71	retval = rt2x00dev->ops->lib->check_firmware(rt2x00dev, fw->data, fw->size);
 72	switch (retval) {
 73	case FW_OK:
 74		break;
 75	case FW_BAD_CRC:
 76		rt2x00_err(rt2x00dev, "Firmware checksum error\n");
 77		goto exit;
 78	case FW_BAD_LENGTH:
 79		rt2x00_err(rt2x00dev, "Invalid firmware file length (len=%zu)\n",
 80			   fw->size);
 81		goto exit;
 82	case FW_BAD_VERSION:
 83		rt2x00_err(rt2x00dev, "Current firmware does not support detected chipset\n");
 84		goto exit;
 85	}
 86
 87	rt2x00dev->fw = fw;
 88
 89	return 0;
 90
 91exit:
 92	release_firmware(fw);
 93
 94	return -ENOENT;
 95}
 96
 97int rt2x00lib_load_firmware(struct rt2x00_dev *rt2x00dev)
 98{
 99	int retval;
100
101	if (!test_bit(REQUIRE_FIRMWARE, &rt2x00dev->cap_flags))
102		return 0;
103
104	if (!rt2x00dev->fw) {
105		retval = rt2x00lib_request_firmware(rt2x00dev);
106		if (retval)
107			return retval;
108	}
109
110	/*
111	 * Send firmware to the device.
112	 */
113	retval = rt2x00dev->ops->lib->load_firmware(rt2x00dev,
114						    rt2x00dev->fw->data,
115						    rt2x00dev->fw->size);
116
117	/*
118	 * When the firmware is uploaded to the hardware the LED
119	 * association status might have been triggered, for correct
120	 * LED handling it should now be reset.
121	 */
122	rt2x00leds_led_assoc(rt2x00dev, false);
123
124	return retval;
125}
126
127void rt2x00lib_free_firmware(struct rt2x00_dev *rt2x00dev)
128{
129	release_firmware(rt2x00dev->fw);
130	rt2x00dev->fw = NULL;
131}