1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Support for Intel Camera Imaging ISP subsystem.
4  * Copyright (c) 2015, Intel Corporation.
5  */
6 
7 #include "ia_css_types.h"
8 #include "assert_support.h"
9 #include "ia_css_queue.h" /* sp2host_dequeue_irq_event() */
10 #include "ia_css_eventq.h"
11 #include "ia_css_event.h"	/* ia_css_event_encode()
12 				ia_css_event_decode()
13 				*/
ia_css_eventq_recv(ia_css_queue_t * eventq_handle,uint8_t * payload)14 int ia_css_eventq_recv(
15     ia_css_queue_t *eventq_handle,
16     uint8_t *payload)
17 {
18 	u32 sp_event;
19 	int error;
20 
21 	/* dequeue the IRQ event */
22 	error = ia_css_queue_dequeue(eventq_handle, &sp_event);
23 
24 	/* check whether the IRQ event is available or not */
25 	if (!error)
26 		ia_css_event_decode(sp_event, payload);
27 	return error;
28 }
29 
30 /*
31  * @brief The Host sends the event to the SP.
32  * Refer to "sh_css_sp.h" for details.
33  */
ia_css_eventq_send(ia_css_queue_t * eventq_handle,u8 evt_id,u8 evt_payload_0,u8 evt_payload_1,uint8_t evt_payload_2)34 int ia_css_eventq_send(
35     ia_css_queue_t *eventq_handle,
36     u8 evt_id,
37     u8 evt_payload_0,
38     u8 evt_payload_1,
39     uint8_t evt_payload_2)
40 {
41 	u8 tmp[4];
42 	u32 sw_event;
43 	int error = -ENOSYS;
44 
45 	/*
46 	 * Encode the queue type, the thread ID and
47 	 * the queue ID into the event.
48 	 */
49 	tmp[0] = evt_id;
50 	tmp[1] = evt_payload_0;
51 	tmp[2] = evt_payload_1;
52 	tmp[3] = evt_payload_2;
53 	ia_css_event_encode(tmp, 4, &sw_event);
54 
55 	/* queue the software event (busy-waiting) */
56 	for ( ; ; ) {
57 		error = ia_css_queue_enqueue(eventq_handle, sw_event);
58 		if (error != -ENOBUFS) {
59 			/* We were able to successfully send the event
60 			   or had a real failure. return the status*/
61 			break;
62 		}
63 		/* Wait for the queue to be not full and try again*/
64 		udelay(1);
65 	}
66 	return error;
67 }
68