2 * Copyright 2003-2011 Netlogic Microsystems (Netlogic). All rights
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions are
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in
13 * the documentation and/or other materials provided with the
16 * THIS SOFTWARE IS PROVIDED BY Netlogic Microsystems ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL NETLOGIC OR CONTRIBUTORS BE
20 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
26 * THE POSSIBILITY OF SUCH DAMAGE.
32 #ifndef __NLM_HAL_COP2_H__
33 #define __NLM_HAL_COP2_H__
37 #define COP2_TXMSGSTATUS 2
38 #define COP2_RXMSGSTATUS 3
39 #define COP2_MSGSTATUS1 4
40 #define COP2_MSGCONFIG 5
41 #define COP2_MSGCONFIG1 6
43 #define CROSSTHR_POPQ_EN 0x01
44 #define VC0_POPQ_EN 0x02
45 #define VC1_POPQ_EN 0x04
46 #define VC2_POPQ_EN 0x08
47 #define VC3_POPQ_EN 0x10
48 #define ALL_VC_POPQ_EN 0x1E
49 #define ALL_VC_CT_POPQ_EN 0x1F
55 #define NLM_DEFINE_COP2_ACCESSORS32(name, reg, sel) \
56 static inline uint32_t nlm_read_c2_##name(void) \
59 __asm__ __volatile__ ( \
63 "mfc2 %0, $%1, %2\n" \
66 : "i" (reg), "i" (sel)); \
70 static inline void nlm_write_c2_##name(uint32_t val) \
72 __asm__ __volatile__( \
76 "mtc2 %0, $%1, %2\n" \
78 : : "r" (val), "i" (reg), "i" (sel)); \
82 #define NLM_DEFINE_COP2_ACCESSORS64(name, reg, sel) \
83 static inline uint64_t nlm_read_c2_##name(void) \
86 __asm__ __volatile__ ( \
90 "dmfc2 %0, $%1, %2\n" \
93 : "i" (reg), "i" (sel)); \
97 static inline void nlm_write_c2_##name(uint64_t val) \
99 __asm__ __volatile__ ( \
103 "dmtc2 %0, $%1, %2\n" \
105 : : "r" (val), "i" (reg), "i" (sel)); \
110 #define NLM_DEFINE_COP2_ACCESSORS64(name, reg, sel) \
111 static inline uint64_t nlm_read_c2_##name(void) \
113 uint32_t __high, __low; \
114 __asm__ __volatile__ ( \
118 "dmfc2 $8, $%2, %3\n" \
119 "dsra32 %0, $8, 0\n" \
122 : "=r"(__high), "=r"(__low) \
123 : "i"(reg), "i"(sel) \
126 return ((uint64_t)__high << 32) | __low; \
129 static inline void nlm_write_c2_##name(uint64_t val) \
131 uint32_t __high = val >> 32; \
132 uint32_t __low = val & 0xffffffff; \
133 __asm__ __volatile__ ( \
137 "dsll32 $8, %1, 0\n" \
138 "dsll32 $9, %0, 0\n" \
139 "dsrl32 $8, $8, 0\n" \
141 "dmtc2 $8, $%2, %3\n" \
143 : : "r"(__high), "r"(__low), "i"(reg), "i"(sel) \
149 NLM_DEFINE_COP2_ACCESSORS64(txbuf0, COP2_TX_BUF, 0);
150 NLM_DEFINE_COP2_ACCESSORS64(txbuf1, COP2_TX_BUF, 1);
151 NLM_DEFINE_COP2_ACCESSORS64(txbuf2, COP2_TX_BUF, 2);
152 NLM_DEFINE_COP2_ACCESSORS64(txbuf3, COP2_TX_BUF, 3);
154 NLM_DEFINE_COP2_ACCESSORS64(rxbuf0, COP2_RX_BUF, 0);
155 NLM_DEFINE_COP2_ACCESSORS64(rxbuf1, COP2_RX_BUF, 1);
156 NLM_DEFINE_COP2_ACCESSORS64(rxbuf2, COP2_RX_BUF, 2);
157 NLM_DEFINE_COP2_ACCESSORS64(rxbuf3, COP2_RX_BUF, 3);
159 NLM_DEFINE_COP2_ACCESSORS32(txmsgstatus, COP2_TXMSGSTATUS, 0);
160 NLM_DEFINE_COP2_ACCESSORS32(rxmsgstatus, COP2_RXMSGSTATUS, 0);
161 NLM_DEFINE_COP2_ACCESSORS32(msgstatus1, COP2_MSGSTATUS1, 0);
162 NLM_DEFINE_COP2_ACCESSORS32(msgconfig, COP2_MSGCONFIG, 0);
163 NLM_DEFINE_COP2_ACCESSORS32(msgconfig1, COP2_MSGCONFIG1, 0);
165 /* successful completion returns 1, else 0 */
176 "/* msgsnds $9, $8 */\n"
195 "/* msgld $9, $8 */\n"
221 nlm_fmn_msgsend(int dstid, int size, int swcode, struct nlm_fmn_msg *m)
223 uint32_t flags, status;
227 flags = nlm_save_flags_cop2();
230 nlm_write_c2_txbuf3(m->msg[3]);
232 nlm_write_c2_txbuf2(m->msg[2]);
234 nlm_write_c2_txbuf1(m->msg[1]);
236 nlm_write_c2_txbuf0(m->msg[0]);
239 dstid |= ((swcode << 24) | (size << 16));
240 status = nlm_msgsend(dstid);
243 rv = nlm_read_c2_txmsgstatus();
244 nlm_restore_flags(flags);
250 nlm_fmn_msgrcv(int vc, int *srcid, int *size, int *code, struct nlm_fmn_msg *m)
253 uint32_t msg_status, flags;
256 flags = nlm_save_flags_cop2();
257 status = nlm_msgld(vc); /* will return 0, if error */
260 msg_status = nlm_read_c2_rxmsgstatus();
261 *size = ((msg_status >> 26) & 0x3) + 1;
262 *code = (msg_status >> 18) & 0xff;
263 *srcid = (msg_status >> 4) & 0xfff;
267 m->msg[3] = nlm_read_c2_rxbuf3();
269 m->msg[2] = nlm_read_c2_rxbuf2();
271 m->msg[1] = nlm_read_c2_rxbuf1();
273 m->msg[0] = nlm_read_c2_rxbuf0();
276 nlm_restore_flags(flags);
282 nlm_fmn_cpu_init(int int_vec, int ctpe, int v0pe, int v1pe, int v2pe, int v3pe)
284 uint32_t val = nlm_read_c2_msgconfig();
286 /* Note: in XLP PRM 0.8.1, the int_vec bits are un-documented
287 * in msgconfig register of cop2.
288 * As per chip/cpu RTL, [16:20] bits consist of int_vec.
290 val |= ((int_vec & 0x1f) << 16) |
291 ((v3pe & 0x1) << 4) |
292 ((v2pe & 0x1) << 3) |
293 ((v1pe & 0x1) << 2) |
294 ((v0pe & 0x1) << 1) |
297 nlm_write_c2_msgconfig(val);