mirror of https://gitee.com/openkylin/linux.git
223 lines
5.6 KiB
C
223 lines
5.6 KiB
C
/*
|
|
* Atheros CARL9170 driver
|
|
*
|
|
* Basic HW register/memory/command access functions
|
|
*
|
|
* Copyright 2008, Johannes Berg <johannes@sipsolutions.net>
|
|
*
|
|
* 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; see the file COPYING. If not, see
|
|
* http://www.gnu.org/licenses/.
|
|
*
|
|
* This file incorporates work covered by the following copyright and
|
|
* permission notice:
|
|
* Copyright (c) 2007-2008 Atheros Communications, Inc.
|
|
*
|
|
* Permission to use, copy, modify, and/or 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 <asm/div64.h>
|
|
#include "carl9170.h"
|
|
#include "cmd.h"
|
|
|
|
int carl9170_write_reg(struct ar9170 *ar, const u32 reg, const u32 val)
|
|
{
|
|
const __le32 buf[2] = {
|
|
cpu_to_le32(reg),
|
|
cpu_to_le32(val),
|
|
};
|
|
int err;
|
|
|
|
err = carl9170_exec_cmd(ar, CARL9170_CMD_WREG, sizeof(buf),
|
|
(u8 *) buf, 0, NULL);
|
|
if (err) {
|
|
if (net_ratelimit()) {
|
|
wiphy_err(ar->hw->wiphy, "writing reg %#x "
|
|
"(val %#x) failed (%d)\n", reg, val, err);
|
|
}
|
|
}
|
|
return err;
|
|
}
|
|
|
|
int carl9170_read_mreg(struct ar9170 *ar, const int nregs,
|
|
const u32 *regs, u32 *out)
|
|
{
|
|
int i, err;
|
|
__le32 *offs, *res;
|
|
|
|
/* abuse "out" for the register offsets, must be same length */
|
|
offs = (__le32 *)out;
|
|
for (i = 0; i < nregs; i++)
|
|
offs[i] = cpu_to_le32(regs[i]);
|
|
|
|
/* also use the same buffer for the input */
|
|
res = (__le32 *)out;
|
|
|
|
err = carl9170_exec_cmd(ar, CARL9170_CMD_RREG,
|
|
4 * nregs, (u8 *)offs,
|
|
4 * nregs, (u8 *)res);
|
|
if (err) {
|
|
if (net_ratelimit()) {
|
|
wiphy_err(ar->hw->wiphy, "reading regs failed (%d)\n",
|
|
err);
|
|
}
|
|
return err;
|
|
}
|
|
|
|
/* convert result to cpu endian */
|
|
for (i = 0; i < nregs; i++)
|
|
out[i] = le32_to_cpu(res[i]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int carl9170_read_reg(struct ar9170 *ar, u32 reg, u32 *val)
|
|
{
|
|
return carl9170_read_mreg(ar, 1, ®, val);
|
|
}
|
|
|
|
int carl9170_echo_test(struct ar9170 *ar, const u32 v)
|
|
{
|
|
u32 echores;
|
|
int err;
|
|
|
|
err = carl9170_exec_cmd(ar, CARL9170_CMD_ECHO,
|
|
4, (u8 *)&v,
|
|
4, (u8 *)&echores);
|
|
if (err)
|
|
return err;
|
|
|
|
if (v != echores) {
|
|
wiphy_info(ar->hw->wiphy, "wrong echo %x != %x", v, echores);
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
struct carl9170_cmd *carl9170_cmd_buf(struct ar9170 *ar,
|
|
const enum carl9170_cmd_oids cmd, const unsigned int len)
|
|
{
|
|
struct carl9170_cmd *tmp;
|
|
|
|
tmp = kzalloc(sizeof(struct carl9170_cmd_head) + len, GFP_ATOMIC);
|
|
if (tmp) {
|
|
tmp->hdr.cmd = cmd;
|
|
tmp->hdr.len = len;
|
|
}
|
|
|
|
return tmp;
|
|
}
|
|
|
|
int carl9170_reboot(struct ar9170 *ar)
|
|
{
|
|
struct carl9170_cmd *cmd;
|
|
int err;
|
|
|
|
cmd = carl9170_cmd_buf(ar, CARL9170_CMD_REBOOT_ASYNC, 0);
|
|
if (!cmd)
|
|
return -ENOMEM;
|
|
|
|
err = __carl9170_exec_cmd(ar, cmd, true);
|
|
return err;
|
|
}
|
|
|
|
int carl9170_mac_reset(struct ar9170 *ar)
|
|
{
|
|
return carl9170_exec_cmd(ar, CARL9170_CMD_SWRST,
|
|
0, NULL, 0, NULL);
|
|
}
|
|
|
|
int carl9170_bcn_ctrl(struct ar9170 *ar, const unsigned int vif_id,
|
|
const u32 mode, const u32 addr, const u32 len)
|
|
{
|
|
struct carl9170_cmd *cmd;
|
|
|
|
cmd = carl9170_cmd_buf(ar, CARL9170_CMD_BCN_CTRL_ASYNC,
|
|
sizeof(struct carl9170_bcn_ctrl_cmd));
|
|
if (!cmd)
|
|
return -ENOMEM;
|
|
|
|
cmd->bcn_ctrl.vif_id = cpu_to_le32(vif_id);
|
|
cmd->bcn_ctrl.mode = cpu_to_le32(mode);
|
|
cmd->bcn_ctrl.bcn_addr = cpu_to_le32(addr);
|
|
cmd->bcn_ctrl.bcn_len = cpu_to_le32(len);
|
|
|
|
return __carl9170_exec_cmd(ar, cmd, true);
|
|
}
|
|
|
|
int carl9170_collect_tally(struct ar9170 *ar)
|
|
{
|
|
struct carl9170_tally_rsp tally;
|
|
struct survey_info *info;
|
|
unsigned int tick;
|
|
int err;
|
|
|
|
err = carl9170_exec_cmd(ar, CARL9170_CMD_TALLY, 0, NULL,
|
|
sizeof(tally), (u8 *)&tally);
|
|
if (err)
|
|
return err;
|
|
|
|
tick = le32_to_cpu(tally.tick);
|
|
if (tick) {
|
|
ar->tally.active += le32_to_cpu(tally.active) / tick;
|
|
ar->tally.cca += le32_to_cpu(tally.cca) / tick;
|
|
ar->tally.tx_time += le32_to_cpu(tally.tx_time) / tick;
|
|
ar->tally.rx_total += le32_to_cpu(tally.rx_total);
|
|
ar->tally.rx_overrun += le32_to_cpu(tally.rx_overrun);
|
|
|
|
if (ar->channel) {
|
|
info = &ar->survey[ar->channel->hw_value];
|
|
info->time = ar->tally.active;
|
|
info->time_busy = ar->tally.cca;
|
|
info->time_tx = ar->tally.tx_time;
|
|
do_div(info->time, 1000);
|
|
do_div(info->time_busy, 1000);
|
|
do_div(info->time_tx, 1000);
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int carl9170_powersave(struct ar9170 *ar, const bool ps)
|
|
{
|
|
struct carl9170_cmd *cmd;
|
|
u32 state;
|
|
|
|
cmd = carl9170_cmd_buf(ar, CARL9170_CMD_PSM_ASYNC,
|
|
sizeof(struct carl9170_psm));
|
|
if (!cmd)
|
|
return -ENOMEM;
|
|
|
|
if (ps) {
|
|
/* Sleep until next TBTT */
|
|
state = CARL9170_PSM_SLEEP | 1;
|
|
} else {
|
|
/* wake up immediately */
|
|
state = 1;
|
|
}
|
|
|
|
cmd->psm.state = cpu_to_le32(state);
|
|
return __carl9170_exec_cmd(ar, cmd, true);
|
|
}
|