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
|
/*
* Video pipeline (VPL) support for barebox
*
* (C) Copyright 2014 Sascha Hauer, Pengutronix
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License as
* published by the Free Software Foundation; either version 2 of
* the License, or (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
*/
#define pr_fmt(fmt) "VPL: " fmt
#include <common.h>
#include <driver.h>
#include <of_graph.h>
#include <linux/list.h>
#include <video/vpl.h>
static LIST_HEAD(vpls);
int vpl_register(struct vpl *vpl)
{
list_add_tail(&vpl->list, &vpls);
pr_debug("%s: %s\n", __func__, vpl->node->full_name);
return 0;
}
static struct vpl *of_find_vpl(struct device_node *node)
{
struct vpl *vpl;
list_for_each_entry(vpl, &vpls, list)
if (vpl->node == node)
return vpl;
return NULL;
}
struct vpl *of_vpl_get(struct device_node *node, int port)
{
node = of_graph_get_port_by_id(node, port);
if (!node)
return NULL;
pr_debug("%s: port: %s\n", __func__, node->full_name);
node = of_graph_get_remote_port_parent(node);
if (!node)
return NULL;
pr_debug("%s: remote port parent: %s\n", __func__, node->full_name);
return of_find_vpl(node);
}
int vpl_ioctl(struct vpl *vpl, unsigned int port,
unsigned int cmd, void *ptr)
{
struct device_node *node, *endpoint;
int ret;
pr_debug("%s: %s port %d\n", __func__, vpl->node->full_name, port);
node = of_graph_get_port_by_id(vpl->node, port);
if (!node) {
pr_err("%s: no port %d on %s\n", __func__, port, vpl->node->full_name);
return -ENODEV;
}
for_each_child_of_node(node, endpoint) {
struct device_node *remote, *remote_parent;
struct vpl *remote_vpl;
u32 remote_port_id;
remote = of_graph_get_remote_port(endpoint);
if (!remote) {
pr_debug("%s: no remote for endpoint %s\n", __func__, endpoint->full_name);
continue;
}
of_property_read_u32(remote, "reg", &remote_port_id);
remote_parent = of_graph_get_remote_port_parent(endpoint);
if (!remote_parent) {
pr_debug("%s: no remote_parent\n", __func__);
return -ENODEV;
}
if (!of_device_is_available(remote_parent))
continue;
remote_vpl = of_find_vpl(remote_parent);
if (!remote_vpl) {
pr_debug("%s: cannot find remote vpl %s\n", __func__, remote->full_name);
continue;
}
ret = remote_vpl->ioctl(remote_vpl, remote_port_id, cmd, ptr);
if (ret)
return ret;
}
return 0;
}
|
