#include <sys/cdefs.h>
#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;
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;
if ((le16toh(hdr->signature) >> 4) == sc->fwsig) {
sc->fwver = le16toh(hdr->version);
RTWN_DPRINTF(sc, RTWN_DEBUG_FIRMWARE,
"FW (%s) V%u.%u %02u-%02u %02u:%02u\n",
sc->fwname,
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);
}
rtwn_fw_download_enable(sc, 1);
error = 0;
for (ntries = 0; ntries < 3; ntries++) {
const u_char *curr_ptr = ptr;
const int maxpages = len / R92C_FW_PAGE_SIZE;
int page;
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;
}
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;
}
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);
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