freebsd-dev/sys/dev/rtwn/if_rtwn_fw.c

225 lines
5.5 KiB
C
Raw Normal View History

/* $OpenBSD: if_urtwn.c,v 1.16 2011/02/10 17:26:40 jakemsr Exp $ */
/*-
* Copyright (c) 2010 Damien Bergamini <damien.bergamini@free.fr>
* Copyright (c) 2014 Kevin Lo <kevlo@FreeBSD.org>
* Copyright (c) 2015-2016 Andriy Voskoboinyk <avos@FreeBSD.org>
*
* Permission to use, copy, modify, and distribute this software for any
* purpose with or without fee is hereby granted, provided that the above
* copyright notice and this permission notice appear in all copies.
*
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*/
#include <sys/cdefs.h>
__FBSDID("$FreeBSD$");
#include "opt_wlan.h"
#include <sys/param.h>
#include <sys/lock.h>
#include <sys/mutex.h>
#include <sys/mbuf.h>
#include <sys/kernel.h>
#include <sys/socket.h>
#include <sys/systm.h>
#include <sys/malloc.h>
#include <sys/queue.h>
#include <sys/taskqueue.h>
#include <sys/bus.h>
#include <sys/endian.h>
#include <sys/linker.h>
#include <sys/firmware.h>
#include <net/if.h>
#include <net/ethernet.h>
#include <net/if_media.h>
#include <net80211/ieee80211_var.h>
#include <net80211/ieee80211_radiotap.h>
#include <dev/rtwn/if_rtwnreg.h>
#include <dev/rtwn/if_rtwnvar.h>
#include <dev/rtwn/if_rtwn_debug.h>
#include <dev/rtwn/if_rtwn_fw.h>
#include <dev/rtwn/rtl8192c/r92c_reg.h>
#ifndef RTWN_WITHOUT_UCODE
static int
rtwn_fw_loadpage(struct rtwn_softc *sc, int page, const uint8_t *buf,
int len)
{
uint32_t reg;
uint16_t off;
int mlen, error;
reg = rtwn_read_4(sc, R92C_MCUFWDL);
reg = RW(reg, R92C_MCUFWDL_PAGE, page);
rtwn_write_4(sc, R92C_MCUFWDL, reg);
error = 0;
off = R92C_FW_START_ADDR;
while (len > 0) {
if (len > R92C_FW_MAX_BLOCK_SIZE)
mlen = R92C_FW_MAX_BLOCK_SIZE;
else if (len > 4)
mlen = 4;
else
mlen = 1;
error = rtwn_fw_write_block(sc, buf, off, mlen);
if (error != 0)
break;
off += mlen;
buf += mlen;
len -= mlen;
}
if (error != 0) {
RTWN_DPRINTF(sc, RTWN_DEBUG_FIRMWARE,
"%s: could not load firmware page %d (offset %u)\n",
__func__, page, off);
}
return (error);
}
static int
rtwn_fw_checksum_report(struct rtwn_softc *sc)
{
int ntries;
for (ntries = 0; ntries < 25; ntries++) {
if (rtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_CHKSUM_RPT)
break;
rtwn_delay(sc, 10000);
}
if (ntries == 25) {
RTWN_DPRINTF(sc, RTWN_DEBUG_FIRMWARE,
"timeout waiting for checksum report\n");
return (ETIMEDOUT);
}
return (0);
}
int
rtwn_load_firmware(struct rtwn_softc *sc)
{
const struct firmware *fw;
const struct r92c_fw_hdr *hdr;
const u_char *ptr;
size_t len;
int ntries, error;
/* Read firmware image from the filesystem. */
RTWN_UNLOCK(sc);
fw = firmware_get(sc->fwname);
RTWN_LOCK(sc);
if (fw == NULL) {
device_printf(sc->sc_dev,
"failed loadfirmware of file %s\n", sc->fwname);
return (ENOENT);
}
len = fw->datasize;
if (len < sizeof(*hdr) || len > sc->fwsize_limit) {
device_printf(sc->sc_dev, "wrong firmware size (%zu)\n", len);
error = EINVAL;
goto fail;
}
ptr = fw->data;
hdr = (const struct r92c_fw_hdr *)ptr;
/* Check if there is a valid FW header and skip it. */
if ((le16toh(hdr->signature) >> 4) == sc->fwsig) {
sc->fwver = le16toh(hdr->version);
RTWN_DPRINTF(sc, RTWN_DEBUG_FIRMWARE,
"FW V%u.%u %02u-%02u %02u:%02u\n",
le16toh(hdr->version), le16toh(hdr->subversion),
hdr->month, hdr->date, hdr->hour, hdr->minute);
ptr += sizeof(*hdr);
len -= sizeof(*hdr);
}
if (rtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RAM_DL_SEL) {
rtwn_write_1(sc, R92C_MCUFWDL, 0);
rtwn_fw_reset(sc, RTWN_FW_RESET_DOWNLOAD);
}
/* Enable firmware download. */
rtwn_fw_download_enable(sc, 1);
error = 0; /* compiler warning */
for (ntries = 0; ntries < 3; ntries++) {
const u_char *curr_ptr = ptr;
const int maxpages = len / R92C_FW_PAGE_SIZE;
int page;
/* Reset the FWDL checksum. */
rtwn_setbits_1(sc, R92C_MCUFWDL, 0, R92C_MCUFWDL_CHKSUM_RPT);
for (page = 0; page < maxpages; page++) {
error = rtwn_fw_loadpage(sc, page, curr_ptr,
R92C_FW_PAGE_SIZE);
if (error != 0)
break;
curr_ptr += R92C_FW_PAGE_SIZE;
}
if (page != maxpages)
continue;
if (len % R92C_FW_PAGE_SIZE != 0) {
error = rtwn_fw_loadpage(sc, page, curr_ptr,
len % R92C_FW_PAGE_SIZE);
if (error != 0)
continue;
}
/* Wait for checksum report. */
error = rtwn_fw_checksum_report(sc);
if (error == 0)
break;
}
if (ntries == 3) {
device_printf(sc->sc_dev,
"%s: failed to upload firmware %s (error %d)\n",
__func__, sc->fwname, error);
goto fail;
}
/* Disable firmware download. */
rtwn_fw_download_enable(sc, 0);
rtwn_setbits_4(sc, R92C_MCUFWDL, R92C_MCUFWDL_WINTINI_RDY,
R92C_MCUFWDL_RDY);
rtwn_fw_reset(sc, RTWN_FW_RESET_CHECKSUM);
/* Wait for firmware readiness. */
for (ntries = 0; ntries < 20; ntries++) {
if (rtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_WINTINI_RDY)
break;
rtwn_delay(sc, 10000);
}
if (ntries == 20) {
device_printf(sc->sc_dev,
"timeout waiting for firmware readiness\n");
error = ETIMEDOUT;
goto fail;
}
fail:
firmware_put(fw, FIRMWARE_UNLOAD);
return (error);
}
#endif