Merge branch 'fix/misc' into for-linus
[linux-2.6] / drivers / net / wireless / ar9170 / cmd.c
1 /*
2  * Atheros AR9170 driver
3  *
4  * Basic HW register/memory/command access functions
5  *
6  * Copyright 2008, Johannes Berg <johannes@sipsolutions.net>
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License as published by
10  * the Free Software Foundation; either version 2 of the License, or
11  * (at your option) any later version.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; see the file COPYING.  If not, see
20  * http://www.gnu.org/licenses/.
21  *
22  * This file incorporates work covered by the following copyright and
23  * permission notice:
24  *    Copyright (c) 2007-2008 Atheros Communications, Inc.
25  *
26  *    Permission to use, copy, modify, and/or distribute this software for any
27  *    purpose with or without fee is hereby granted, provided that the above
28  *    copyright notice and this permission notice appear in all copies.
29  *
30  *    THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
31  *    WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
32  *    MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
33  *    ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
34  *    WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
35  *    ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
36  *    OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
37  */
38
39 #include "ar9170.h"
40 #include "cmd.h"
41
42 int ar9170_write_mem(struct ar9170 *ar, const __le32 *data, size_t len)
43 {
44         int err;
45
46         if (unlikely(!IS_ACCEPTING_CMD(ar)))
47                 return 0;
48
49         err = ar->exec_cmd(ar, AR9170_CMD_WMEM, len, (u8 *) data, 0, NULL);
50         if (err)
51                 printk(KERN_DEBUG "%s: writing memory failed\n",
52                        wiphy_name(ar->hw->wiphy));
53         return err;
54 }
55
56 int ar9170_write_reg(struct ar9170 *ar, const u32 reg, const u32 val)
57 {
58         __le32 buf[2] = {
59                 cpu_to_le32(reg),
60                 cpu_to_le32(val),
61         };
62         int err;
63
64         if (unlikely(!IS_ACCEPTING_CMD(ar)))
65                 return 0;
66
67         err = ar->exec_cmd(ar, AR9170_CMD_WREG, sizeof(buf),
68                            (u8 *) buf, 0, NULL);
69         if (err)
70                 printk(KERN_DEBUG "%s: writing reg %#x (val %#x) failed\n",
71                        wiphy_name(ar->hw->wiphy), reg, val);
72         return err;
73 }
74
75 static int ar9170_read_mreg(struct ar9170 *ar, int nregs,
76                             const u32 *regs, u32 *out)
77 {
78         int i, err;
79         __le32 *offs, *res;
80
81         if (unlikely(!IS_ACCEPTING_CMD(ar)))
82                 return 0;
83
84         /* abuse "out" for the register offsets, must be same length */
85         offs = (__le32 *)out;
86         for (i = 0; i < nregs; i++)
87                 offs[i] = cpu_to_le32(regs[i]);
88
89         /* also use the same buffer for the input */
90         res = (__le32 *)out;
91
92         err = ar->exec_cmd(ar, AR9170_CMD_RREG,
93                            4 * nregs, (u8 *)offs,
94                            4 * nregs, (u8 *)res);
95         if (err)
96                 return err;
97
98         /* convert result to cpu endian */
99         for (i = 0; i < nregs; i++)
100                 out[i] = le32_to_cpu(res[i]);
101
102         return 0;
103 }
104
105 int ar9170_read_reg(struct ar9170 *ar, u32 reg, u32 *val)
106 {
107         return ar9170_read_mreg(ar, 1, &reg, val);
108 }
109
110 int ar9170_echo_test(struct ar9170 *ar, u32 v)
111 {
112         __le32 echobuf = cpu_to_le32(v);
113         __le32 echores;
114         int err;
115
116         if (unlikely(!IS_ACCEPTING_CMD(ar)))
117                 return -ENODEV;
118
119         err = ar->exec_cmd(ar, AR9170_CMD_ECHO,
120                            4, (u8 *)&echobuf,
121                            4, (u8 *)&echores);
122         if (err)
123                 return err;
124
125         if (echobuf != echores)
126                 return -EINVAL;
127
128         return 0;
129 }