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
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
|
/**
* @file
*
* @ingroup raspberrypi_vc
*
* @brief video core support.
*
*/
/*
* Copyright (c) 2015 Yang Qiao
*
* The license and distribution terms for this file may be
* found in the file LICENSE in this distribution or at
*
* http://www.rtems.org/license/LICENSE
*
*/
#include <pthread.h>
#include <bsp.h>
#include <bsp/raspberrypi.h>
#include <bsp/mailbox.h>
#include <bsp/vc.h>
#include "vc_defines.h"
#if (RPI_L2_CACHE_ENABLE == 1)
#define BCM2835_VC_MEMORY_MAPPING 0x40000000
#else
#define BCM2835_VC_MEMORY_MAPPING 0xC0000000
#endif
static inline bool
bcm2835_mailbox_buffer_suceeded(const bcm2835_mbox_buf_hdr *hdr)
{
return (hdr->buf_code == BCM2835_MBOX_BUF_CODE_REQUEST_SUCCEED);
}
static inline int
bcm2835_mailbox_send_read_buffer(void *buf)
{
raspberrypi_mailbox_write(BCM2835_MBOX_CHANNEL_PROP_AVC,
(unsigned int)buf + BCM2835_VC_MEMORY_MAPPING);
raspberrypi_mailbox_read(BCM2835_MBOX_CHANNEL_PROP_AVC);
return 0;
}
#define BCM2835_MBOX_VAL_LENGTH_MASK(_val_len) \
(_val_len&(~BCM2835_MBOX_TAG_VAL_LEN_RESPONSE))
int
bcm2835_mailbox_get_display_size(bcm2835_get_display_size_entries *_entries)
{
struct {
bcm2835_mbox_buf_hdr hdr;
bcm2835_mbox_tag_display_size get_display_size;
uint32_t end_tag;
}buffer __attribute__((aligned (16)));
BCM2835_MBOX_INIT_BUF(&buffer);
BCM2835_MBOX_INIT_TAG_NO_REQ(&buffer.get_display_size,
BCM2835_MAILBOX_TAG_GET_DISPLAY_SIZE);
if (bcm2835_mailbox_send_read_buffer(&buffer))
return -1;
_entries->width = buffer.get_display_size.body.resp.width;
_entries->height = buffer.get_display_size.body.resp.height;
if( !bcm2835_mailbox_buffer_suceeded(&buffer.hdr) )
return -2;
return 0;
}
int
bcm2835_mailbox_init_frame_buffer(bcm2835_init_frame_buffer_entries* _entries)
{
struct {
bcm2835_mbox_buf_hdr hdr;
bcm2835_mbox_tag_display_size set_display_size;
bcm2835_mbox_tag_virtual_size set_virtual_size;
bcm2835_mbox_tag_depth set_depth;
bcm2835_mbox_tag_pixel_order set_pixel_order;
bcm2835_mbox_tag_alpha_mode set_alpha_mode;
bcm2835_mbox_tag_virtual_offset set_virtual_offset;
bcm2835_mbox_tag_overscan set_overscan;
bcm2835_mbox_tag_allocate_buffer allocate_buffer;
bcm2835_mbox_tag_get_pitch get_pitch;
uint32_t end_tag;
} buffer __attribute__((aligned (16)));
BCM2835_MBOX_INIT_BUF(&buffer);
BCM2835_MBOX_INIT_TAG(&buffer.set_display_size,
BCM2835_MAILBOX_TAG_SET_DISPLAY_SIZE);
buffer.set_display_size.body.req.width = _entries->xres;
buffer.set_display_size.body.req.height = _entries->yres;
BCM2835_MBOX_INIT_TAG(&buffer.set_virtual_size,
BCM2835_MAILBOX_TAG_SET_VIRTUAL_SIZE);
buffer.set_virtual_size.body.req.vwidth = _entries->xvirt;
buffer.set_virtual_size.body.req.vheight = _entries->yvirt;
BCM2835_MBOX_INIT_TAG(&buffer.set_depth,
BCM2835_MAILBOX_TAG_SET_DEPTH);
buffer.set_depth.body.req.depth = _entries->depth;
BCM2835_MBOX_INIT_TAG(&buffer.set_pixel_order,
BCM2835_MAILBOX_TAG_SET_PIXEL_ORDER);
buffer.set_pixel_order.body.req.pixel_order = _entries->pixel_order;
BCM2835_MBOX_INIT_TAG(&buffer.set_alpha_mode,
BCM2835_MAILBOX_TAG_SET_ALPHA_MODE);
buffer.set_alpha_mode.body.req.alpha_mode = _entries->alpha_mode;
BCM2835_MBOX_INIT_TAG(&buffer.set_virtual_offset,
BCM2835_MAILBOX_TAG_SET_VIRTUAL_OFFSET);
buffer.set_virtual_offset.body.req.voffset_x = _entries->voffset_x;
buffer.set_virtual_offset.body.req.voffset_x = _entries->voffset_y;
BCM2835_MBOX_INIT_TAG(&buffer.set_overscan,
BCM2835_MAILBOX_TAG_SET_OVERSCAN);
buffer.set_overscan.body.req.overscan_top = _entries->overscan_top;
buffer.set_overscan.body.req.overscan_bottom = _entries->overscan_bottom;
buffer.set_overscan.body.req.overscan_left = _entries->overscan_left;
buffer.set_overscan.body.req.overscan_right = _entries->overscan_right;
BCM2835_MBOX_INIT_TAG(&buffer.allocate_buffer,
BCM2835_MAILBOX_TAG_ALLOCATE_BUFFER);
buffer.allocate_buffer.body.req.align = 0x100;
BCM2835_MBOX_INIT_TAG_NO_REQ(&buffer.get_pitch,
BCM2835_MAILBOX_TAG_GET_PITCH);
if (bcm2835_mailbox_send_read_buffer(&buffer))
return -1;
_entries->xres = buffer.set_display_size.body.resp.width;
_entries->yres = buffer.set_display_size.body.resp.height;
_entries->xvirt = buffer.set_virtual_size.body.resp.vwidth;
_entries->yvirt = buffer.set_virtual_size.body.resp.vheight;
_entries->depth = buffer.set_depth.body.resp.depth;
#if (BSP_IS_RPI2 == 1)
_entries->base = buffer.allocate_buffer.body.resp.base;
#else
_entries->base = buffer.allocate_buffer.body.resp.base
- BCM2835_VC_MEMORY_MAPPING;
#endif
_entries->size = buffer.allocate_buffer.body.resp.size;
_entries->pixel_order = buffer.set_pixel_order.body.resp.pixel_order;
_entries->alpha_mode = buffer.set_alpha_mode.body.resp.alpha_mode;
_entries->voffset_x = buffer.set_virtual_offset.body.resp.voffset_x;
_entries->voffset_y = buffer.set_virtual_offset.body.resp.voffset_y;
_entries->overscan_left = buffer.set_overscan.body.resp.overscan_left;
_entries->overscan_right = buffer.set_overscan.body.resp.overscan_right;
_entries->overscan_top = buffer.set_overscan.body.resp.overscan_top;
_entries->overscan_bottom = buffer.set_overscan.body.resp.overscan_bottom;
if( !bcm2835_mailbox_buffer_suceeded(&buffer.hdr) )
return -2;
return 0;
}
int
bcm2835_mailbox_get_pitch(bcm2835_get_pitch_entries* _entries)
{
struct {
bcm2835_mbox_buf_hdr hdr;
bcm2835_mbox_tag_get_pitch get_pitch;
uint32_t end_tag;
}buffer __attribute__((aligned (16)));
BCM2835_MBOX_INIT_BUF(&buffer);
BCM2835_MBOX_INIT_TAG_NO_REQ(&buffer.get_pitch,
BCM2835_MAILBOX_TAG_GET_PITCH);
if (bcm2835_mailbox_send_read_buffer(&buffer))
return -1;
_entries->pitch = buffer.get_pitch.body.resp.pitch;
if( !bcm2835_mailbox_buffer_suceeded(&buffer.hdr) )
return -2;
return 0;
}
int
bcm2835_mailbox_get_cmdline(bcm2835_get_cmdline_entries* _entries)
{
int i;
struct {
bcm2835_mbox_buf_hdr hdr;
bcm2835_mbox_tag_get_cmd_line get_cmd_line;
uint32_t end_tag;
}buffer __attribute__((aligned (16)));
BCM2835_MBOX_INIT_BUF(&buffer);
BCM2835_MBOX_INIT_TAG_NO_REQ(&buffer.get_cmd_line,
BCM2835_MAILBOX_TAG_GET_CMD_LINE);
if (bcm2835_mailbox_send_read_buffer(&buffer))
return -1;
for (i = 0;
i < BCM2835_MBOX_VAL_LENGTH_MASK(buffer.get_cmd_line.tag_hdr.val_len);
++i)
{
_entries->cmdline[i] = buffer.get_cmd_line.body.resp.cmdline[i];
}
_entries->cmdline[i] = '\0';
if( !bcm2835_mailbox_buffer_suceeded(&buffer.hdr) )
return -2;
return 0;
}
int
bcm2835_mailbox_set_power_state(bcm2835_set_power_state_entries *_entries)
{
struct {
bcm2835_mbox_buf_hdr hdr;
bcm2835_mbox_tag_power_state set_power_state;
uint32_t end_tag;
}buffer __attribute__((aligned (16)));
BCM2835_MBOX_INIT_BUF(&buffer);
BCM2835_MBOX_INIT_TAG(&buffer.set_power_state,
BCM2835_MAILBOX_TAG_SET_POWER_STATE);
buffer.set_power_state.body.req.dev_id = _entries->dev_id;
buffer.set_power_state.body.req.state = _entries->state;
if (bcm2835_mailbox_send_read_buffer(&buffer))
return -1;
_entries->dev_id = buffer.set_power_state.body.resp.dev_id;
_entries->state = buffer.set_power_state.body.resp.state;
if( !bcm2835_mailbox_buffer_suceeded(&buffer.hdr) )
return -2;
return 0;
}
int
bcm2835_mailbox_get_arm_memory(bcm2835_get_arm_memory_entries* _entries)
{
struct {
bcm2835_mbox_buf_hdr hdr;
bcm2835_mbox_tag_get_arm_memory get_arm_memory;
uint32_t end_tag;
}buffer __attribute__((aligned (16)));
BCM2835_MBOX_INIT_BUF(&buffer);
BCM2835_MBOX_INIT_TAG_NO_REQ(&buffer.get_arm_memory,
BCM2835_MAILBOX_TAG_GET_ARM_MEMORY);
if (bcm2835_mailbox_send_read_buffer(&buffer))
return -1;
_entries->base = buffer.get_arm_memory.body.resp.base;
_entries->size = buffer.get_arm_memory.body.resp.size;
if( !bcm2835_mailbox_buffer_suceeded(&buffer.hdr) )
return -2;
return 0;
}
int
bcm2835_mailbox_get_vc_memory(bcm2835_get_vc_memory_entries* _entries)
{
struct {
bcm2835_mbox_buf_hdr hdr;
bcm2835_mbox_tag_get_vc_memory get_vc_memory;
uint32_t end_tag;
}buffer __attribute__((aligned (16)));
BCM2835_MBOX_INIT_BUF(&buffer);
BCM2835_MBOX_INIT_TAG_NO_REQ(&buffer.get_vc_memory,
BCM2835_MAILBOX_TAG_GET_VC_MEMORY);
if (bcm2835_mailbox_send_read_buffer(&buffer))
return -1;
_entries->base = buffer.get_vc_memory.body.resp.base;
_entries->size = buffer.get_vc_memory.body.resp.size;
if( !bcm2835_mailbox_buffer_suceeded(&buffer.hdr) )
return -2;
return 0;
}
|
