1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
|
/* Copyright 2021 The Chromium OS Authors. All rights reserved.
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*/
#include "console.h"
#include "hooks.h"
#include "ipi_chip.h"
#include "queue.h"
#include "queue_policies.h"
#include "registers.h"
#include "task.h"
#include "util.h"
#include "vdec.h"
#define CPRINTF(format, args...) cprintf(CC_IPI, format, ##args)
#define CPRINTS(format, args...) cprints(CC_IPI, format, ##args)
static void event_vdec_written(struct consumer const *consumer, size_t count)
{
task_wake(TASK_ID_VDEC_SERVICE);
}
static struct consumer const event_vdec_consumer;
static struct queue const event_vdec_queue = QUEUE_DIRECT(8,
struct vdec_msg, null_producer, event_vdec_consumer);
static struct consumer const event_vdec_consumer = {
.queue = &event_vdec_queue,
.ops = &((struct consumer_ops const) {
.written = event_vdec_written,
}),
};
static void event_vdec_core_written(struct consumer const *consumer,
size_t count)
{
task_wake(TASK_ID_VDEC_CORE_SERVICE);
}
static struct consumer const event_vdec_core_consumer;
static struct queue const event_vdec_core_queue = QUEUE_DIRECT(8,
struct vdec_msg, null_producer, event_vdec_core_consumer);
static struct consumer const event_vdec_core_consumer = {
.queue = &event_vdec_core_queue,
.ops = &((struct consumer_ops const) {
.written = event_vdec_core_written,
}),
};
/* Stub functions only provided by private overlays. */
#ifndef HAVE_PRIVATE_MT_SCP
void vdec_msg_handler(void *data) {}
void vdec_core_msg_handler(void *data) {}
#endif
static void vdec_h264_ipi_handler(int id, void *data, uint32_t len)
{
struct vdec_msg rsv_msg;
if (!len) {
CPRINTS("len is zero.");
return;
}
rsv_msg.type = VDEC_LAT;
memcpy(rsv_msg.msg, data, MIN(len, sizeof(rsv_msg.msg)));
/*
* If there is no other IPI handler touch this queue, we don't need to
* interrupt_disable() or task_disable_irq().
*/
if (!queue_add_unit(&event_vdec_queue, &rsv_msg))
CPRINTS("Could not send vdec %d to the queue.", rsv_msg.type);
}
DECLARE_IPI(SCP_IPI_VDEC_LAT, vdec_h264_ipi_handler, 0);
static void vdec_h264_ipi_core_handler(int id, void *data, uint32_t len)
{
struct vdec_msg rsv_msg;
if (!len) {
CPRINTS("len is zero.");
return;
}
rsv_msg.type = VDEC_CORE;
memcpy(rsv_msg.msg, data, MIN(len, sizeof(rsv_msg.msg)));
/*
* If there is no other IPI handler touch this queue, we don't need to
* interrupt_disable() or task_disable_irq().
*/
if (!queue_add_unit(&event_vdec_core_queue, &rsv_msg))
CPRINTS("Could not send vdec %d to core queue.", rsv_msg.type);
}
DECLARE_IPI(SCP_IPI_VDEC_CORE, vdec_h264_ipi_core_handler, 0);
void vdec_service_task(void *u)
{
struct vdec_msg rsv_msg;
size_t size;
while (1) {
/*
* Queue unit is added in IPI handler, which is in ISR context.
* Disable IRQ to prevent a clobbered queue.
*/
ipi_disable_irq();
size = queue_remove_unit(&event_vdec_queue, &rsv_msg);
ipi_enable_irq();
if (!size)
task_wait_event(-1);
else
vdec_msg_handler(rsv_msg.msg);
}
}
void vdec_core_service_task(void *u)
{
struct vdec_msg rsv_msg;
size_t size;
while (1) {
/*
* Queue unit is added in IPI handler, which is in ISR context.
* Disable IRQ to prevent a clobbered queue.
*/
ipi_disable_irq();
size = queue_remove_unit(&event_vdec_core_queue, &rsv_msg);
ipi_enable_irq();
if (!size)
task_wait_event(-1);
else
vdec_core_msg_handler(rsv_msg.msg);
}
}
|
