[FOSS_TLK]security: tlk_driver: add FIQ glue
[tegra/ote_partner/tlk_driver.git] / security / tlk_driver / ote_fiq_glue.c
1 /*
2  * Copyright (c) 2014 NVIDIA Corporation. All rights reserved.
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License as published by
6  * the Free Software Foundation; either version 2 of the License, or
7  * (at your option) any later version.
8  *
9  * This program is distributed in the hope that it will be useful, but WITHOUT
10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
12  * more details.
13  *
14  * You should have received a copy of the GNU General Public License along
15  * with this program; if not, write to the Free Software Foundation, Inc.,
16  * 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
17  */
18
19 #include <linux/platform_device.h>
20 #include <linux/slab.h>
21 #include <linux/fiq_glue.h>
22
23 #include "ote_protocol.h"
24
25 static struct fiq_glue_handler *current_handler;
26
27 void tlk_fiq_handler(struct pt_regs *regs, void *svc_sp)
28 {
29         current_handler->fiq(current_handler, regs, svc_sp);
30 }
31
32 int fiq_glue_register_handler(struct fiq_glue_handler *handler)
33 {
34         int ret;
35
36         if (!handler || !handler->fiq)
37                 return -EINVAL;
38
39         if (current_handler)
40                 return -EBUSY;
41
42         current_handler = handler;
43
44         ret = tlk_generic_smc(TE_SMC_REGISTER_FIQ_GLUE,
45                         (uintptr_t)tlk_fiq_glue_aarch64, 0);
46         if (ret)
47                 pr_err("%s: failed to register FIQ glue\n", __func__);
48
49         return ret;
50 }