1*5113495bSYour Name /*
2*5113495bSYour Name * Copyright (c) 2017 The Linux Foundation. All rights reserved.
3*5113495bSYour Name *
4*5113495bSYour Name * Permission to use, copy, modify, and/or distribute this software for
5*5113495bSYour Name * any purpose with or without fee is hereby granted, provided that the
6*5113495bSYour Name * above copyright notice and this permission notice appear in all
7*5113495bSYour Name * copies.
8*5113495bSYour Name *
9*5113495bSYour Name * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
10*5113495bSYour Name * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
11*5113495bSYour Name * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
12*5113495bSYour Name * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
13*5113495bSYour Name * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
14*5113495bSYour Name * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
15*5113495bSYour Name * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
16*5113495bSYour Name * PERFORMANCE OF THIS SOFTWARE.
17*5113495bSYour Name */
18*5113495bSYour Name
19*5113495bSYour Name /**
20*5113495bSYour Name * DOC: qdf_cpuhp (CPU hotplug)
21*5113495bSYour Name * QCA driver framework (QDF) CPU hotplug APIs
22*5113495bSYour Name */
23*5113495bSYour Name
24*5113495bSYour Name #include "qdf_cpuhp.h"
25*5113495bSYour Name #include "i_qdf_cpuhp.h"
26*5113495bSYour Name #include "qdf_list.h"
27*5113495bSYour Name #include "qdf_lock.h"
28*5113495bSYour Name
29*5113495bSYour Name static qdf_mutex_t qdf_cpuhp_lock;
30*5113495bSYour Name static qdf_list_t qdf_cpuhp_handlers;
31*5113495bSYour Name
32*5113495bSYour Name struct qdf_cpuhp_handler {
33*5113495bSYour Name qdf_list_node_t node;
34*5113495bSYour Name void *context;
35*5113495bSYour Name qdf_cpuhp_callback up_callback;
36*5113495bSYour Name qdf_cpuhp_callback down_callback;
37*5113495bSYour Name };
38*5113495bSYour Name
qdf_cpuhp_on_up(uint32_t cpu)39*5113495bSYour Name static void qdf_cpuhp_on_up(uint32_t cpu)
40*5113495bSYour Name {
41*5113495bSYour Name QDF_STATUS status;
42*5113495bSYour Name qdf_list_node_t *node;
43*5113495bSYour Name
44*5113495bSYour Name qdf_mutex_acquire(&qdf_cpuhp_lock);
45*5113495bSYour Name
46*5113495bSYour Name status = qdf_list_peek_front(&qdf_cpuhp_handlers, &node);
47*5113495bSYour Name while (QDF_IS_STATUS_SUCCESS(status)) {
48*5113495bSYour Name struct qdf_cpuhp_handler *handler =
49*5113495bSYour Name qdf_container_of(node, struct qdf_cpuhp_handler, node);
50*5113495bSYour Name if (handler->up_callback)
51*5113495bSYour Name handler->up_callback(handler->context, cpu);
52*5113495bSYour Name
53*5113495bSYour Name status = qdf_list_peek_next(&qdf_cpuhp_handlers, node, &node);
54*5113495bSYour Name }
55*5113495bSYour Name
56*5113495bSYour Name qdf_mutex_release(&qdf_cpuhp_lock);
57*5113495bSYour Name }
58*5113495bSYour Name
qdf_cpuhp_on_down(uint32_t cpu)59*5113495bSYour Name static void qdf_cpuhp_on_down(uint32_t cpu)
60*5113495bSYour Name {
61*5113495bSYour Name QDF_STATUS status;
62*5113495bSYour Name qdf_list_node_t *node;
63*5113495bSYour Name
64*5113495bSYour Name qdf_mutex_acquire(&qdf_cpuhp_lock);
65*5113495bSYour Name
66*5113495bSYour Name status = qdf_list_peek_front(&qdf_cpuhp_handlers, &node);
67*5113495bSYour Name while (QDF_IS_STATUS_SUCCESS(status)) {
68*5113495bSYour Name struct qdf_cpuhp_handler *handler =
69*5113495bSYour Name qdf_container_of(node, struct qdf_cpuhp_handler, node);
70*5113495bSYour Name if (handler->down_callback)
71*5113495bSYour Name handler->down_callback(handler->context, cpu);
72*5113495bSYour Name
73*5113495bSYour Name status = qdf_list_peek_next(&qdf_cpuhp_handlers, node, &node);
74*5113495bSYour Name }
75*5113495bSYour Name
76*5113495bSYour Name qdf_mutex_release(&qdf_cpuhp_lock);
77*5113495bSYour Name }
78*5113495bSYour Name
qdf_cpuhp_init(void)79*5113495bSYour Name QDF_STATUS qdf_cpuhp_init(void)
80*5113495bSYour Name {
81*5113495bSYour Name QDF_STATUS status;
82*5113495bSYour Name
83*5113495bSYour Name status = qdf_mutex_create(&qdf_cpuhp_lock);
84*5113495bSYour Name if (QDF_IS_STATUS_ERROR(status))
85*5113495bSYour Name return status;
86*5113495bSYour Name
87*5113495bSYour Name qdf_list_create(&qdf_cpuhp_handlers, 0);
88*5113495bSYour Name
89*5113495bSYour Name __qdf_cpuhp_os_init(qdf_cpuhp_on_up, qdf_cpuhp_on_down);
90*5113495bSYour Name
91*5113495bSYour Name return QDF_STATUS_SUCCESS;
92*5113495bSYour Name }
93*5113495bSYour Name
qdf_cpuhp_deinit(void)94*5113495bSYour Name QDF_STATUS qdf_cpuhp_deinit(void)
95*5113495bSYour Name {
96*5113495bSYour Name __qdf_cpuhp_os_deinit();
97*5113495bSYour Name qdf_list_destroy(&qdf_cpuhp_handlers);
98*5113495bSYour Name return qdf_mutex_destroy(&qdf_cpuhp_lock);
99*5113495bSYour Name }
100*5113495bSYour Name
qdf_cpuhp_register(struct qdf_cpuhp_handler ** out_handler,void * context,qdf_cpuhp_callback up_callback,qdf_cpuhp_callback down_callback)101*5113495bSYour Name QDF_STATUS qdf_cpuhp_register(struct qdf_cpuhp_handler **out_handler,
102*5113495bSYour Name void *context,
103*5113495bSYour Name qdf_cpuhp_callback up_callback,
104*5113495bSYour Name qdf_cpuhp_callback down_callback)
105*5113495bSYour Name {
106*5113495bSYour Name QDF_STATUS status;
107*5113495bSYour Name struct qdf_cpuhp_handler *handler;
108*5113495bSYour Name
109*5113495bSYour Name *out_handler = NULL;
110*5113495bSYour Name
111*5113495bSYour Name handler = qdf_mem_malloc(sizeof(*handler));
112*5113495bSYour Name if (!handler)
113*5113495bSYour Name return QDF_STATUS_E_NOMEM;
114*5113495bSYour Name
115*5113495bSYour Name handler->context = context;
116*5113495bSYour Name handler->up_callback = up_callback;
117*5113495bSYour Name handler->down_callback = down_callback;
118*5113495bSYour Name
119*5113495bSYour Name status = qdf_mutex_acquire(&qdf_cpuhp_lock);
120*5113495bSYour Name if (QDF_IS_STATUS_ERROR(status))
121*5113495bSYour Name goto free_handler;
122*5113495bSYour Name
123*5113495bSYour Name status = qdf_list_insert_back(&qdf_cpuhp_handlers, &handler->node);
124*5113495bSYour Name if (QDF_IS_STATUS_ERROR(status))
125*5113495bSYour Name goto release_lock;
126*5113495bSYour Name
127*5113495bSYour Name /* this can fail, but there isn't a good way to recover... */
128*5113495bSYour Name qdf_mutex_release(&qdf_cpuhp_lock);
129*5113495bSYour Name
130*5113495bSYour Name *out_handler = handler;
131*5113495bSYour Name
132*5113495bSYour Name return QDF_STATUS_SUCCESS;
133*5113495bSYour Name
134*5113495bSYour Name release_lock:
135*5113495bSYour Name qdf_mutex_release(&qdf_cpuhp_lock);
136*5113495bSYour Name
137*5113495bSYour Name free_handler:
138*5113495bSYour Name qdf_mem_free(handler);
139*5113495bSYour Name
140*5113495bSYour Name return status;
141*5113495bSYour Name }
142*5113495bSYour Name
qdf_cpuhp_unregister(struct qdf_cpuhp_handler ** out_handler)143*5113495bSYour Name void qdf_cpuhp_unregister(struct qdf_cpuhp_handler **out_handler)
144*5113495bSYour Name {
145*5113495bSYour Name struct qdf_cpuhp_handler *handler = *out_handler;
146*5113495bSYour Name
147*5113495bSYour Name QDF_BUG(handler);
148*5113495bSYour Name if (!handler)
149*5113495bSYour Name return;
150*5113495bSYour Name
151*5113495bSYour Name qdf_mutex_acquire(&qdf_cpuhp_lock);
152*5113495bSYour Name qdf_list_remove_node(&qdf_cpuhp_handlers, &handler->node);
153*5113495bSYour Name qdf_mutex_release(&qdf_cpuhp_lock);
154*5113495bSYour Name
155*5113495bSYour Name qdf_mem_free(handler);
156*5113495bSYour Name *out_handler = NULL;
157*5113495bSYour Name }
158*5113495bSYour Name
159