1 /*
2  * Support for Intel Camera Imaging ISP subsystem.
3  * Copyright (c) 2015, Intel Corporation.
4  *
5  * This program is free software; you can redistribute it and/or modify it
6  * under the terms and conditions of the GNU General Public License,
7  * version 2, as published by the Free Software Foundation.
8  *
9  * This program is distributed in the hope 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 
15 #include "ia_css_types.h"
16 #include "assert_support.h"
17 #include "ia_css_queue.h" /* sp2host_dequeue_irq_event() */
18 #include "ia_css_eventq.h"
19 #include "ia_css_event.h"	/* ia_css_event_encode()
20 				ia_css_event_decode()
21 				*/
22 #include "platform_support.h" /* hrt_sleep() */
23 
24 int ia_css_eventq_recv(
25     ia_css_queue_t *eventq_handle,
26     uint8_t *payload)
27 {
28 	u32 sp_event;
29 	int error;
30 
31 	/* dequeue the IRQ event */
32 	error = ia_css_queue_dequeue(eventq_handle, &sp_event);
33 
34 	/* check whether the IRQ event is available or not */
35 	if (!error)
36 		ia_css_event_decode(sp_event, payload);
37 	return error;
38 }
39 
40 /*
41  * @brief The Host sends the event to the SP.
42  * Refer to "sh_css_sp.h" for details.
43  */
44 int ia_css_eventq_send(
45     ia_css_queue_t *eventq_handle,
46     u8 evt_id,
47     u8 evt_payload_0,
48     u8 evt_payload_1,
49     uint8_t evt_payload_2)
50 {
51 	u8 tmp[4];
52 	u32 sw_event;
53 	int error = -ENOSYS;
54 
55 	/*
56 	 * Encode the queue type, the thread ID and
57 	 * the queue ID into the event.
58 	 */
59 	tmp[0] = evt_id;
60 	tmp[1] = evt_payload_0;
61 	tmp[2] = evt_payload_1;
62 	tmp[3] = evt_payload_2;
63 	ia_css_event_encode(tmp, 4, &sw_event);
64 
65 	/* queue the software event (busy-waiting) */
66 	for ( ; ; ) {
67 		error = ia_css_queue_enqueue(eventq_handle, sw_event);
68 		if (error != -ENOBUFS) {
69 			/* We were able to successfully send the event
70 			   or had a real failure. return the status*/
71 			break;
72 		}
73 		/* Wait for the queue to be not full and try again*/
74 		hrt_sleep();
75 	}
76 	return error;
77 }
78