xref: /optee_os/core/kernel/interrupt.c (revision 1bb929836182ecb96d2d9d268daa807c67596396)
1*1bb92983SJerome Forissier // SPDX-License-Identifier: BSD-2-Clause
27315b7b4SJens Wiklander /*
37315b7b4SJens Wiklander  * Copyright (c) 2016, Linaro Limited
47315b7b4SJens Wiklander  * All rights reserved.
57315b7b4SJens Wiklander  *
67315b7b4SJens Wiklander  * Redistribution and use in source and binary forms, with or without
77315b7b4SJens Wiklander  * modification, are permitted provided that the following conditions are met:
87315b7b4SJens Wiklander  *
97315b7b4SJens Wiklander  * 1. Redistributions of source code must retain the above copyright notice,
107315b7b4SJens Wiklander  * this list of conditions and the following disclaimer.
117315b7b4SJens Wiklander  *
127315b7b4SJens Wiklander  * 2. Redistributions in binary form must reproduce the above copyright notice,
137315b7b4SJens Wiklander  * this list of conditions and the following disclaimer in the documentation
147315b7b4SJens Wiklander  * and/or other materials provided with the distribution.
157315b7b4SJens Wiklander  *
167315b7b4SJens Wiklander  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
177315b7b4SJens Wiklander  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
187315b7b4SJens Wiklander  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
197315b7b4SJens Wiklander  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
207315b7b4SJens Wiklander  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
217315b7b4SJens Wiklander  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
227315b7b4SJens Wiklander  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
237315b7b4SJens Wiklander  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
247315b7b4SJens Wiklander  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
257315b7b4SJens Wiklander  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
267315b7b4SJens Wiklander  * POSSIBILITY OF SUCH DAMAGE.
277315b7b4SJens Wiklander  */
287315b7b4SJens Wiklander 
297315b7b4SJens Wiklander #include <kernel/interrupt.h>
307315b7b4SJens Wiklander #include <trace.h>
317315b7b4SJens Wiklander 
327315b7b4SJens Wiklander /*
337315b7b4SJens Wiklander  * NOTE!
347315b7b4SJens Wiklander  *
357315b7b4SJens Wiklander  * We're assuming that there's no concurrent use of this interface, except
367315b7b4SJens Wiklander  * delivery of interrupts in parallel. Synchronization will be needed when
377315b7b4SJens Wiklander  * we begin to modify settings after boot initialization.
387315b7b4SJens Wiklander  */
397315b7b4SJens Wiklander 
407315b7b4SJens Wiklander static struct itr_chip *itr_chip;
417315b7b4SJens Wiklander static SLIST_HEAD(, itr_handler) handlers = SLIST_HEAD_INITIALIZER(handlers);
427315b7b4SJens Wiklander 
437315b7b4SJens Wiklander void itr_init(struct itr_chip *chip)
447315b7b4SJens Wiklander {
457315b7b4SJens Wiklander 	itr_chip = chip;
467315b7b4SJens Wiklander }
477315b7b4SJens Wiklander 
487315b7b4SJens Wiklander static struct itr_handler *find_handler(size_t it)
497315b7b4SJens Wiklander {
507315b7b4SJens Wiklander 	struct itr_handler *h;
517315b7b4SJens Wiklander 
527315b7b4SJens Wiklander 	SLIST_FOREACH(h, &handlers, link)
537315b7b4SJens Wiklander 		if (h->it == it)
547315b7b4SJens Wiklander 			return h;
557315b7b4SJens Wiklander 	return NULL;
567315b7b4SJens Wiklander }
577315b7b4SJens Wiklander 
587315b7b4SJens Wiklander void itr_handle(size_t it)
597315b7b4SJens Wiklander {
607315b7b4SJens Wiklander 	struct itr_handler *h = find_handler(it);
617315b7b4SJens Wiklander 
627315b7b4SJens Wiklander 	if (!h) {
637315b7b4SJens Wiklander 		EMSG("Disabling unhandled interrupt %zu", it);
647315b7b4SJens Wiklander 		itr_chip->ops->disable(itr_chip, it);
657315b7b4SJens Wiklander 		return;
667315b7b4SJens Wiklander 	}
677315b7b4SJens Wiklander 
687315b7b4SJens Wiklander 	if (h->handler(h) != ITRR_HANDLED) {
697315b7b4SJens Wiklander 		EMSG("Disabling interrupt %zu not handled by handler", it);
707315b7b4SJens Wiklander 		itr_chip->ops->disable(itr_chip, it);
717315b7b4SJens Wiklander 	}
727315b7b4SJens Wiklander }
737315b7b4SJens Wiklander 
747315b7b4SJens Wiklander void itr_add(struct itr_handler *h)
757315b7b4SJens Wiklander {
767315b7b4SJens Wiklander 	itr_chip->ops->add(itr_chip, h->it, h->flags);
777315b7b4SJens Wiklander 	SLIST_INSERT_HEAD(&handlers, h, link);
787315b7b4SJens Wiklander }
797315b7b4SJens Wiklander 
8026ed70ecSGuanchao Liang void itr_enable(size_t it)
817315b7b4SJens Wiklander {
8226ed70ecSGuanchao Liang 	itr_chip->ops->enable(itr_chip, it);
837315b7b4SJens Wiklander }
847315b7b4SJens Wiklander 
8526ed70ecSGuanchao Liang void itr_disable(size_t it)
867315b7b4SJens Wiklander {
8726ed70ecSGuanchao Liang 	itr_chip->ops->disable(itr_chip, it);
8826ed70ecSGuanchao Liang }
8926ed70ecSGuanchao Liang 
9026ed70ecSGuanchao Liang void itr_raise_pi(size_t it)
9126ed70ecSGuanchao Liang {
9226ed70ecSGuanchao Liang 	itr_chip->ops->raise_pi(itr_chip, it);
9326ed70ecSGuanchao Liang }
9426ed70ecSGuanchao Liang 
9526ed70ecSGuanchao Liang void itr_raise_sgi(size_t it, uint8_t cpu_mask)
9626ed70ecSGuanchao Liang {
9726ed70ecSGuanchao Liang 	itr_chip->ops->raise_sgi(itr_chip, it, cpu_mask);
9826ed70ecSGuanchao Liang }
9926ed70ecSGuanchao Liang 
10026ed70ecSGuanchao Liang void itr_set_affinity(size_t it, uint8_t cpu_mask)
10126ed70ecSGuanchao Liang {
10226ed70ecSGuanchao Liang 	itr_chip->ops->set_affinity(itr_chip, it, cpu_mask);
1037315b7b4SJens Wiklander }
104