~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/arch/mips/netlogic/xlr/fmn.c

Version: ~ [ linux-5.19-rc3 ] ~ [ linux-5.18.5 ] ~ [ linux-5.17.15 ] ~ [ linux-5.16.20 ] ~ [ linux-5.15.48 ] ~ [ linux-5.14.21 ] ~ [ linux-5.13.19 ] ~ [ linux-5.12.19 ] ~ [ linux-5.11.22 ] ~ [ linux-5.10.123 ] ~ [ linux-5.9.16 ] ~ [ linux-5.8.18 ] ~ [ linux-5.7.19 ] ~ [ linux-5.6.19 ] ~ [ linux-5.5.19 ] ~ [ linux-5.4.199 ] ~ [ linux-5.3.18 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.248 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.284 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.319 ] ~ [ linux-4.8.17 ] ~ [ linux-4.7.10 ] ~ [ linux-4.6.7 ] ~ [ linux-4.5.7 ] ~ [ linux-4.4.302 ] ~ [ linux-4.3.6 ] ~ [ linux-4.2.8 ] ~ [ linux-4.1.52 ] ~ [ linux-4.0.9 ] ~ [ linux-3.10.108 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.9 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

  1 /*
  2  * Copyright (c) 2003-2012 Broadcom Corporation
  3  * All Rights Reserved
  4  *
  5  * This software is available to you under a choice of one of two
  6  * licenses.  You may choose to be licensed under the terms of the GNU
  7  * General Public License (GPL) Version 2, available from the file
  8  * COPYING in the main directory of this source tree, or the Broadcom
  9  * license below:
 10  *
 11  * Redistribution and use in source and binary forms, with or without
 12  * modification, are permitted provided that the following conditions
 13  * are met:
 14  *
 15  * 1. Redistributions of source code must retain the above copyright
 16  *    notice, this list of conditions and the following disclaimer.
 17  * 2. Redistributions in binary form must reproduce the above copyright
 18  *    notice, this list of conditions and the following disclaimer in
 19  *    the documentation and/or other materials provided with the
 20  *    distribution.
 21  *
 22  * THIS SOFTWARE IS PROVIDED BY BROADCOM ``AS IS'' AND ANY EXPRESS OR
 23  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
 24  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 25  * ARE DISCLAIMED. IN NO EVENT SHALL BROADCOM OR CONTRIBUTORS BE LIABLE
 26  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 27  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 28  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
 29  * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
 30  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
 31  * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
 32  * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 33  */
 34 
 35 #include <linux/kernel.h>
 36 #include <linux/irqreturn.h>
 37 #include <linux/irq.h>
 38 #include <linux/interrupt.h>
 39 
 40 #include <asm/mipsregs.h>
 41 #include <asm/netlogic/interrupt.h>
 42 #include <asm/netlogic/xlr/fmn.h>
 43 #include <asm/netlogic/common.h>
 44 
 45 #define COP2_CC_INIT_CPU_DEST(dest, conf) \
 46 do { \
 47         nlm_write_c2_cc##dest(0, conf[(dest * 8) + 0]); \
 48         nlm_write_c2_cc##dest(1, conf[(dest * 8) + 1]); \
 49         nlm_write_c2_cc##dest(2, conf[(dest * 8) + 2]); \
 50         nlm_write_c2_cc##dest(3, conf[(dest * 8) + 3]); \
 51         nlm_write_c2_cc##dest(4, conf[(dest * 8) + 4]); \
 52         nlm_write_c2_cc##dest(5, conf[(dest * 8) + 5]); \
 53         nlm_write_c2_cc##dest(6, conf[(dest * 8) + 6]); \
 54         nlm_write_c2_cc##dest(7, conf[(dest * 8) + 7]); \
 55 } while (0)
 56 
 57 struct fmn_message_handler {
 58         void (*action)(int, int, int, int, struct nlm_fmn_msg *, void *);
 59         void *arg;
 60 } msg_handlers[128];
 61 
 62 /*
 63  * FMN interrupt handler. We configure the FMN so that any messages in
 64  * any of the CPU buckets will trigger an interrupt on the CPU.
 65  * The message can be from any device on the FMN (like NAE/SAE/DMA).
 66  * The source station id is used to figure out which of the registered
 67  * handlers have to be called.
 68  */
 69 static irqreturn_t fmn_message_handler(int irq, void *data)
 70 {
 71         struct fmn_message_handler *hndlr;
 72         int bucket, rv;
 73         int size = 0, code = 0, src_stnid = 0;
 74         struct nlm_fmn_msg msg;
 75         uint32_t mflags, bkt_status;
 76 
 77         mflags = nlm_cop2_enable_irqsave();
 78         /* Disable message ring interrupt */
 79         nlm_fmn_setup_intr(irq, 0);
 80         while (1) {
 81                 /* 8 bkts per core, [24:31] each bit represents one bucket
 82                  * Bit is Zero if bucket is not empty */
 83                 bkt_status = (nlm_read_c2_status0() >> 24) & 0xff;
 84                 if (bkt_status == 0xff)
 85                         break;
 86                 for (bucket = 0; bucket < 8; bucket++) {
 87                         /* Continue on empty bucket */
 88                         if (bkt_status & (1 << bucket))
 89                                 continue;
 90                         rv = nlm_fmn_receive(bucket, &size, &code, &src_stnid,
 91                                                 &msg);
 92                         if (rv != 0)
 93                                 continue;
 94 
 95                         hndlr = &msg_handlers[src_stnid];
 96                         if (hndlr->action == NULL)
 97                                 pr_warn("No msgring handler for stnid %d\n",
 98                                                 src_stnid);
 99                         else {
100                                 nlm_cop2_disable_irqrestore(mflags);
101                                 hndlr->action(bucket, src_stnid, size, code,
102                                         &msg, hndlr->arg);
103                                 mflags = nlm_cop2_enable_irqsave();
104                         }
105                 }
106         }
107         /* Enable message ring intr, to any thread in core */
108         nlm_fmn_setup_intr(irq, (1 << nlm_threads_per_core) - 1);
109         nlm_cop2_disable_irqrestore(mflags);
110         return IRQ_HANDLED;
111 }
112 
113 void xlr_percpu_fmn_init(void)
114 {
115         struct xlr_fmn_info *cpu_fmn_info;
116         int *bucket_sizes;
117         uint32_t flags;
118         int id;
119 
120         BUG_ON(nlm_thread_id() != 0);
121         id = nlm_core_id();
122 
123         bucket_sizes = xlr_board_fmn_config.bucket_size;
124         cpu_fmn_info = &xlr_board_fmn_config.cpu[id];
125         flags = nlm_cop2_enable_irqsave();
126 
127         /* Setup bucket sizes for the core. */
128         nlm_write_c2_bucksize(0, bucket_sizes[id * 8 + 0]);
129         nlm_write_c2_bucksize(1, bucket_sizes[id * 8 + 1]);
130         nlm_write_c2_bucksize(2, bucket_sizes[id * 8 + 2]);
131         nlm_write_c2_bucksize(3, bucket_sizes[id * 8 + 3]);
132         nlm_write_c2_bucksize(4, bucket_sizes[id * 8 + 4]);
133         nlm_write_c2_bucksize(5, bucket_sizes[id * 8 + 5]);
134         nlm_write_c2_bucksize(6, bucket_sizes[id * 8 + 6]);
135         nlm_write_c2_bucksize(7, bucket_sizes[id * 8 + 7]);
136 
137         /*
138          * For sending FMN messages, we need credits on the destination
139          * bucket. Program the credits this core has on the 128 possible
140          * destination buckets.
141          * We cannot use a loop here, because the the first argument has
142          * to be a constant integer value.
143          */
144         COP2_CC_INIT_CPU_DEST(0, cpu_fmn_info->credit_config);
145         COP2_CC_INIT_CPU_DEST(1, cpu_fmn_info->credit_config);
146         COP2_CC_INIT_CPU_DEST(2, cpu_fmn_info->credit_config);
147         COP2_CC_INIT_CPU_DEST(3, cpu_fmn_info->credit_config);
148         COP2_CC_INIT_CPU_DEST(4, cpu_fmn_info->credit_config);
149         COP2_CC_INIT_CPU_DEST(5, cpu_fmn_info->credit_config);
150         COP2_CC_INIT_CPU_DEST(6, cpu_fmn_info->credit_config);
151         COP2_CC_INIT_CPU_DEST(7, cpu_fmn_info->credit_config);
152         COP2_CC_INIT_CPU_DEST(8, cpu_fmn_info->credit_config);
153         COP2_CC_INIT_CPU_DEST(9, cpu_fmn_info->credit_config);
154         COP2_CC_INIT_CPU_DEST(10, cpu_fmn_info->credit_config);
155         COP2_CC_INIT_CPU_DEST(11, cpu_fmn_info->credit_config);
156         COP2_CC_INIT_CPU_DEST(12, cpu_fmn_info->credit_config);
157         COP2_CC_INIT_CPU_DEST(13, cpu_fmn_info->credit_config);
158         COP2_CC_INIT_CPU_DEST(14, cpu_fmn_info->credit_config);
159         COP2_CC_INIT_CPU_DEST(15, cpu_fmn_info->credit_config);
160 
161         /* enable FMN interrupts on this CPU */
162         nlm_fmn_setup_intr(IRQ_FMN, (1 << nlm_threads_per_core) - 1);
163         nlm_cop2_disable_irqrestore(flags);
164 }
165 
166 
167 /*
168  * Register a FMN message handler with respect to the source station id
169  * @stnid: source station id
170  * @action: Handler function pointer
171  */
172 int nlm_register_fmn_handler(int start_stnid, int end_stnid,
173         void (*action)(int, int, int, int, struct nlm_fmn_msg *, void *),
174         void *arg)
175 {
176         int sstnid;
177 
178         for (sstnid = start_stnid; sstnid <= end_stnid; sstnid++) {
179                 msg_handlers[sstnid].arg = arg;
180                 smp_wmb();
181                 msg_handlers[sstnid].action = action;
182         }
183         pr_debug("Registered FMN msg handler for stnid %d-%d\n",
184                         start_stnid, end_stnid);
185         return 0;
186 }
187 
188 void nlm_setup_fmn_irq(void)
189 {
190         uint32_t flags;
191 
192         /* request irq only once */
193         if (request_irq(IRQ_FMN, fmn_message_handler, IRQF_PERCPU, "fmn", NULL))
194                 pr_err("Failed to request irq %d (fmn)\n", IRQ_FMN);
195 
196         flags = nlm_cop2_enable_irqsave();
197         nlm_fmn_setup_intr(IRQ_FMN, (1 << nlm_threads_per_core) - 1);
198         nlm_cop2_disable_irqrestore(flags);
199 }
200 

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | Wiki (Japanese) | Wiki (English) | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

osdn.jp