1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (C) 2016 Freescale Semiconductor, Inc.
4 * Copyright 2017~2018 NXP
5 * Author: Dong Aisheng <aisheng.dong@nxp.com>
6 *
7 * File containing client-side RPC functions for the MISC service. These
8 * function are ported to clients that communicate to the SC.
9 *
10 */
11
12 #include <linux/firmware/imx/svc/misc.h>
13
14 struct imx_sc_msg_req_misc_set_ctrl {
15 struct imx_sc_rpc_msg hdr;
16 u32 ctrl;
17 u32 val;
18 u16 resource;
19 } __packed __aligned(4);
20
21 struct imx_sc_msg_req_cpu_start {
22 struct imx_sc_rpc_msg hdr;
23 u32 address_hi;
24 u32 address_lo;
25 u16 resource;
26 u8 enable;
27 } __packed __aligned(4);
28
29 struct imx_sc_msg_req_misc_get_ctrl {
30 struct imx_sc_rpc_msg hdr;
31 u32 ctrl;
32 u16 resource;
33 } __packed __aligned(4);
34
35 struct imx_sc_msg_resp_misc_get_ctrl {
36 struct imx_sc_rpc_msg hdr;
37 u32 val;
38 } __packed __aligned(4);
39
40 /*
41 * This function sets a miscellaneous control value.
42 *
43 * @param[in] ipc IPC handle
44 * @param[in] resource resource the control is associated with
45 * @param[in] ctrl control to change
46 * @param[in] val value to apply to the control
47 *
48 * @return Returns 0 for success and < 0 for errors.
49 */
50
imx_sc_misc_set_control(struct imx_sc_ipc * ipc,u32 resource,u8 ctrl,u32 val)51 int imx_sc_misc_set_control(struct imx_sc_ipc *ipc, u32 resource,
52 u8 ctrl, u32 val)
53 {
54 struct imx_sc_msg_req_misc_set_ctrl msg;
55 struct imx_sc_rpc_msg *hdr = &msg.hdr;
56
57 hdr->ver = IMX_SC_RPC_VERSION;
58 hdr->svc = (uint8_t)IMX_SC_RPC_SVC_MISC;
59 hdr->func = (uint8_t)IMX_SC_MISC_FUNC_SET_CONTROL;
60 hdr->size = 4;
61
62 msg.ctrl = ctrl;
63 msg.val = val;
64 msg.resource = resource;
65
66 return imx_scu_call_rpc(ipc, &msg, true);
67 }
68 EXPORT_SYMBOL(imx_sc_misc_set_control);
69
70 /*
71 * This function gets a miscellaneous control value.
72 *
73 * @param[in] ipc IPC handle
74 * @param[in] resource resource the control is associated with
75 * @param[in] ctrl control to get
76 * @param[out] val pointer to return the control value
77 *
78 * @return Returns 0 for success and < 0 for errors.
79 */
80
imx_sc_misc_get_control(struct imx_sc_ipc * ipc,u32 resource,u8 ctrl,u32 * val)81 int imx_sc_misc_get_control(struct imx_sc_ipc *ipc, u32 resource,
82 u8 ctrl, u32 *val)
83 {
84 struct imx_sc_msg_req_misc_get_ctrl msg;
85 struct imx_sc_msg_resp_misc_get_ctrl *resp;
86 struct imx_sc_rpc_msg *hdr = &msg.hdr;
87 int ret;
88
89 hdr->ver = IMX_SC_RPC_VERSION;
90 hdr->svc = (uint8_t)IMX_SC_RPC_SVC_MISC;
91 hdr->func = (uint8_t)IMX_SC_MISC_FUNC_GET_CONTROL;
92 hdr->size = 3;
93
94 msg.ctrl = ctrl;
95 msg.resource = resource;
96
97 ret = imx_scu_call_rpc(ipc, &msg, true);
98 if (ret)
99 return ret;
100
101 resp = (struct imx_sc_msg_resp_misc_get_ctrl *)&msg;
102 if (val != NULL)
103 *val = resp->val;
104
105 return 0;
106 }
107 EXPORT_SYMBOL(imx_sc_misc_get_control);
108
109 /*
110 * This function starts/stops a CPU identified by @resource
111 *
112 * @param[in] ipc IPC handle
113 * @param[in] resource resource the control is associated with
114 * @param[in] enable true for start, false for stop
115 * @param[in] phys_addr initial instruction address to be executed
116 *
117 * @return Returns 0 for success and < 0 for errors.
118 */
imx_sc_pm_cpu_start(struct imx_sc_ipc * ipc,u32 resource,bool enable,u64 phys_addr)119 int imx_sc_pm_cpu_start(struct imx_sc_ipc *ipc, u32 resource,
120 bool enable, u64 phys_addr)
121 {
122 struct imx_sc_msg_req_cpu_start msg;
123 struct imx_sc_rpc_msg *hdr = &msg.hdr;
124
125 hdr->ver = IMX_SC_RPC_VERSION;
126 hdr->svc = IMX_SC_RPC_SVC_PM;
127 hdr->func = IMX_SC_PM_FUNC_CPU_START;
128 hdr->size = 4;
129
130 msg.address_hi = phys_addr >> 32;
131 msg.address_lo = phys_addr;
132 msg.resource = resource;
133 msg.enable = enable;
134
135 return imx_scu_call_rpc(ipc, &msg, true);
136 }
137 EXPORT_SYMBOL(imx_sc_pm_cpu_start);
138