static void rpi_get_board_rev(void)
{
int ret;
char *name;
BCM2835_MBOX_STACK_ALIGN(struct msg_get_board_rev, msg);
BCM2835_MBOX_INIT_HDR(msg);
BCM2835_MBOX_INIT_TAG(&msg->get_board_rev, GET_BOARD_REV);
ret = bcm2835_mbox_call_prop(BCM2835_MBOX_PROP_CHAN, &msg->hdr);
if (ret) {
printf("bcm2835: Could not query board revision\n");
/* Ignore error; not critical */
return;
}
/* Comments from u-boot:
* For details of old-vs-new scheme, see:
* https://github.com/pimoroni/RPi.version/blob/master/RPi/version.py
* http://www.raspberrypi.org/forums/viewtopic.php?f=63&t=99293&p=690282
* (a few posts down)
*
* For the RPi 1, bit 24 is the "warranty bit", so we mask off just the
* lower byte to use as the board rev:
* http://www.raspberrypi.org/forums/viewtopic.php?f=63&t=98367&start=250
* http://www.raspberrypi.org/forums/viewtopic.php?f=31&t=20594
*/
rpi_board_rev = msg->get_board_rev.body.resp.rev;
if (rpi_board_rev & 0x800000)
rpi_board_rev = (rpi_board_rev >> 4) & 0xff;
else
int bcm2835_mailbox_set_power_state( bcm2835_set_power_state_entries *_entries )
{
struct BCM2835_MBOX_BUF_ALIGN_ATTRIBUTE {
bcm2835_mbox_buf_hdr hdr;
bcm2835_mbox_tag_power_state set_power_state;
uint32_t end_tag;
uint32_t padding_reserve[16];
} buffer;
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;
bcm2835_mailbox_buffer_flush_and_invalidate( &buffer, sizeof( buffer ) );
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;
}
static struct clk *rpi_register_firmware_clock(u32 clock_id, const char *name)
{
BCM2835_MBOX_STACK_ALIGN(struct msg_get_clock_rate, msg);
int ret;
BCM2835_MBOX_INIT_HDR(msg);
BCM2835_MBOX_INIT_TAG(&msg->get_clock_rate, GET_CLOCK_RATE);
msg->get_clock_rate.body.req.clock_id = clock_id;
ret = bcm2835_mbox_call_prop(BCM2835_MBOX_PROP_CHAN, &msg->hdr);
if (ret)
return ERR_PTR(ret);
return clk_fixed(name, msg->get_clock_rate.body.resp.rate_hz);
}
static int rpi_get_arm_mem(u32 *size)
{
BCM2835_MBOX_STACK_ALIGN(struct msg_get_arm_mem, msg);
int ret;
BCM2835_MBOX_INIT_HDR(msg);
BCM2835_MBOX_INIT_TAG(&msg->get_arm_mem, GET_ARM_MEMORY);
ret = bcm2835_mbox_call_prop(BCM2835_MBOX_PROP_CHAN, &msg->hdr);
if (ret)
return ret;
*size = msg->get_arm_mem.body.resp.mem_size;
return 0;
}
void rpi_set_usbethaddr(void)
{
BCM2835_MBOX_STACK_ALIGN(struct msg_get_mac_address, msg);
int ret;
BCM2835_MBOX_INIT_HDR(msg);
BCM2835_MBOX_INIT_TAG(&msg->get_mac_address, GET_MAC_ADDRESS);
ret = bcm2835_mbox_call_prop(BCM2835_MBOX_PROP_CHAN, &msg->hdr);
if (ret) {
printf("bcm2835: Could not query MAC address\n");
/* Ignore error; not critical */
return;
}
eth_register_ethaddr(0, msg->get_mac_address.body.resp.mac);
}
static int rpi_register_clkdev(u32 clock_id, const char *name)
{
BCM2835_MBOX_STACK_ALIGN(struct msg_get_clock_rate, msg);
struct clk *clk;
int ret;
BCM2835_MBOX_INIT_HDR(msg);
BCM2835_MBOX_INIT_TAG(&msg->get_clock_rate, GET_CLOCK_RATE);
msg->get_clock_rate.body.req.clock_id = clock_id;
ret = bcm2835_mbox_call_prop(BCM2835_MBOX_PROP_CHAN, &msg->hdr);
if (ret)
return ret;
clk = clk_fixed(name, msg->get_clock_rate.body.resp.rate_hz);
if (IS_ERR(clk))
return PTR_ERR(clk);
if (!clk_register_clkdev(clk, NULL, name))
return -ENODEV;
return 0;
}
int bcm2835_mailbox_init_frame_buffer(
bcm2835_init_frame_buffer_entries *_entries )
{
struct BCM2835_MBOX_BUF_ALIGN_ATTRIBUTE {
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;
uint32_t padding_reserve[16];
} buffer;
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 );
bcm2835_mailbox_buffer_flush_and_invalidate( &buffer, sizeof( buffer ) );
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;
_entries->base = buffer.allocate_buffer.body.resp.base;
_entries->base &= BCM2835_VC_MEMORY_MAPPING_MASK;
_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;
if ( !BCM2835_MBOX_TAG_REPLY_IS_SET( &buffer.allocate_buffer ) )
return -3;
if ( _entries->base < 0x100000 )
return -4;
return 0;
}
