xref: /src/sys/arch/evbarm/rpi/vcprop_subr.c

/*	$NetBSD: vcprop_subr.c,v 1.10 2021/03/08 13:53:08 mlelstv Exp $	*/

/*
 * Copyright (c) 2014 Michael Lorenz
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

/*
 * Mailbox property interface wrapper functions
 */
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: vcprop_subr.c,v 1.10 2021/03/08 13:53:08 mlelstv Exp $");

#include <sys/param.h>
#include <sys/bus.h>
#include <sys/device.h>
#include <sys/endian.h>

#include <uvm/uvm_extern.h>

#include <arm/broadcom/bcm2835reg.h>
#include <arm/broadcom/bcm2835var.h>
#include <arm/broadcom/bcm2835_mbox.h>

#include <evbarm/rpi/vcio.h>
#include <evbarm/rpi/vcpm.h>
#include <evbarm/rpi/vcprop.h>

#include <dev/wscons/wsconsio.h>

int
rpi_fb_set_video(int b)
{
	int error;
	uint32_t res;

	/*
	 * might as well put it here since we need to re-init it every time
	 * and it's not like this is going to be called very often anyway
	 */
	struct __aligned(16) {
		struct vcprop_buffer_hdr	vb_hdr;
		struct vcprop_tag_blankscreen	vbt_blank;
		struct vcprop_tag end;
	} vb_setblank =
	{
		.vb_hdr = {
			.vpb_len = htole32(sizeof(vb_setblank)),
			.vpb_rcode = htole32(VCPROP_PROCESS_REQUEST),
		},
		.vbt_blank = {
			.tag = {
				.vpt_tag = htole32(VCPROPTAG_BLANK_SCREEN),
				.vpt_len = htole32(VCPROPTAG_LEN(
				    vb_setblank.vbt_blank)),
				.vpt_rcode = htole32(VCPROPTAG_REQUEST),
			},
			.state = htole32((b != 0) ?
			    VCPROP_BLANK_OFF : VCPROP_BLANK_ON),
		},
		.end = {
			.vpt_tag = htole32(VCPROPTAG_NULL),
		},
	};

	error = bcmmbox_request(BCMMBOX_CHANARM2VC, &vb_setblank,
	    sizeof(vb_setblank), &res);
#ifdef RPI_IOCTL_DEBUG
	printf("%s: %d %d %d %08x %08x\n", __func__, b,
	    le32toh(vb_setblank.vbt_blank.state), error, res,
	    le32toh(vb_setblank.vbt_blank.tag.vpt_rcode));
#endif
	if (error)
		return error;

	if (!vcprop_buffer_success_p(&vb_setblank.vb_hdr) ||
	    !vcprop_tag_success_p(&vb_setblank.vbt_blank.tag)) {
		return EIO;
	}

	return 0;
}

uint32_t
rpi_alloc_mem(uint32_t size, uint32_t align, uint32_t flags)
{
	int error;
	uint32_t res;

	struct __aligned(16) {
		struct vcprop_buffer_hdr	vb_hdr;
		struct vcprop_tag_allocmem	vbt_am;
		struct vcprop_tag end;
	} vb_allocmem =
	{
		.vb_hdr = {
			.vpb_len = htole32(sizeof(vb_allocmem)),
			.vpb_rcode = htole32(VCPROP_PROCESS_REQUEST),
		},
		.vbt_am = {
			.tag = {
				.vpt_tag = htole32(VCPROPTAG_ALLOCMEM),
				.vpt_len =
				    htole32(VCPROPTAG_LEN(vb_allocmem.vbt_am)),
				.vpt_rcode = htole32(VCPROPTAG_REQUEST),
			},
			.size = htole32(size),
			.align = htole32(align),
			.flags = htole32(flags),
		},
		.end = {
			.vpt_tag = htole32(VCPROPTAG_NULL),
		},
	};

	error = bcmmbox_request(BCMMBOX_CHANARM2VC, &vb_allocmem,
	    sizeof(vb_allocmem), &res);
#ifdef RPI_IOCTL_DEBUG
	printf("%s: %d %d %08x %08x\n", __func__,
	    le32toh(vb_allocmem.vbt_am.size), error, res,
	    le32toh(vb_allocmem.vbt_am.tag.vpt_rcode));
#endif
	if (error)
		return error;

	if (!vcprop_buffer_success_p(&vb_allocmem.vb_hdr) ||
	    !vcprop_tag_success_p(&vb_allocmem.vbt_am.tag)) {
		return EIO;
	}

	/* Return the handle from the VC */
	return le32toh(vb_allocmem.vbt_am.size);
}

bus_addr_t
rpi_lock_mem(uint32_t handle)
{
	int error;
	uint32_t res;

	struct __aligned(16) {
		struct vcprop_buffer_hdr	vb_hdr;
		struct vcprop_tag_lockmem	vbt_lm;
		struct vcprop_tag end;
	} vb_lockmem =
	{
		.vb_hdr = {
			.vpb_len = htole32(sizeof(vb_lockmem)),
			.vpb_rcode = htole32(VCPROP_PROCESS_REQUEST),
		},
		.vbt_lm = {
			.tag = {
				.vpt_tag = htole32(VCPROPTAG_LOCKMEM),
				.vpt_len =
				    htole32(VCPROPTAG_LEN(vb_lockmem.vbt_lm)),
				.vpt_rcode = htole32(VCPROPTAG_REQUEST),
			},
			.handle = htole32(handle),
		},
		.end = {
			.vpt_tag = htole32(VCPROPTAG_NULL),
		},
	};

	error = bcmmbox_request(BCMMBOX_CHANARM2VC, &vb_lockmem,
	    sizeof(vb_lockmem), &res);
#ifdef RPI_IOCTL_DEBUG
	printf("%s: %d %d %08x %08x\n", __func__,
	    le32toh(vb_lockmem.vbt_lm.handle), error, res,
	    le32toh(vb_lockmem.vbt_lm.tag.vpt_rcode));
#endif
	if (error)
		return 0;

	if (!vcprop_buffer_success_p(&vb_lockmem.vb_hdr) ||
	    !vcprop_tag_success_p(&vb_lockmem.vbt_lm.tag)) {
		return 0;
	}

	return le32toh(vb_lockmem.vbt_lm.handle);
}

int
rpi_unlock_mem(uint32_t handle)
{
	int error;
	uint32_t res;

	struct __aligned(16) {
		struct vcprop_buffer_hdr	vb_hdr;
		struct vcprop_tag_lockmem	vbt_lm;
		struct vcprop_tag end;
	} vb_unlockmem =
	{
		.vb_hdr = {
			.vpb_len = htole32(sizeof(vb_unlockmem)),
			.vpb_rcode = htole32(VCPROP_PROCESS_REQUEST),
		},
		.vbt_lm = {
			.tag = {
				.vpt_tag = htole32(VCPROPTAG_UNLOCKMEM),
				.vpt_len =
				    htole32(VCPROPTAG_LEN(vb_unlockmem.vbt_lm)),
				.vpt_rcode = htole32(VCPROPTAG_REQUEST),
			},
			.handle = htole32(handle),
		},
		.end = {
			.vpt_tag = htole32(VCPROPTAG_NULL),
		},
	};

	error = bcmmbox_request(BCMMBOX_CHANARM2VC, &vb_unlockmem,
	    sizeof(vb_unlockmem), &res);
#ifdef RPI_IOCTL_DEBUG
	printf("%s: %d %d %08x %08x\n", __func__,
	    le32toh(vb_unlockmem.vbt_lm.handle), error, res,
	    le32toh(vb_unlockmem.vbt_lm.tag.vpt_rcode));
#endif
	if (error)
		return error;

	if (!vcprop_buffer_success_p(&vb_unlockmem.vb_hdr) ||
	    !vcprop_tag_success_p(&vb_unlockmem.vbt_lm.tag)) {
		return EIO;
	}

	return 0;
}

int
rpi_release_mem(uint32_t handle)
{
	int error;
	uint32_t res;

	struct __aligned(16) {
		struct vcprop_buffer_hdr	vb_hdr;
		struct vcprop_tag_lockmem	vbt_lm;
		struct vcprop_tag end;
	} vb_releasemem =
	{
		.vb_hdr = {
			.vpb_len = htole32(sizeof(vb_releasemem)),
			.vpb_rcode = htole32(VCPROP_PROCESS_REQUEST),
		},
		.vbt_lm = {
			.tag = {
				.vpt_tag = htole32(VCPROPTAG_RELEASEMEM),
				.vpt_len = htole32(VCPROPTAG_LEN(
				    vb_releasemem.vbt_lm)),
				.vpt_rcode = htole32(VCPROPTAG_REQUEST),
			},
			.handle = htole32(handle),
		},
		.end = {
			.vpt_tag = htole32(VCPROPTAG_NULL),
		},
	};

	error = bcmmbox_request(BCMMBOX_CHANARM2VC, &vb_releasemem,
	    sizeof(vb_releasemem), &res);
#ifdef RPI_IOCTL_DEBUG
	printf("%s: %d %d %08x %08x\n", __func__,
	    le32toh(vb_releasemem.vbt_lm.handle), error, res,
	    le32toh(vb_releasemem.vbt_lm.tag.vpt_rcode));
#endif
	if (error)
		return error;

	if (!vcprop_buffer_success_p(&vb_releasemem.vb_hdr) ||
	    !vcprop_tag_success_p(&vb_releasemem.vbt_lm.tag)) {
		return EIO;
	}

	return 0;
}

int
rpi_fb_movecursor(int x, int y, int on)
{
	int error;
	uint32_t res;

	struct __aligned(16) {
		struct vcprop_buffer_hdr	vb_hdr;
		struct vcprop_tag_cursorstate	vbt_cs;
		struct vcprop_tag end;
	} vb_cursorstate =
	{
		.vb_hdr = {
			.vpb_len = htole32(sizeof(vb_cursorstate)),
			.vpb_rcode = htole32(VCPROP_PROCESS_REQUEST),
		},
		.vbt_cs = {
			.tag = {
				.vpt_tag = htole32(VCPROPTAG_SET_CURSOR_STATE),
				.vpt_len = htole32(VCPROPTAG_LEN(
				    vb_cursorstate.vbt_cs)),
				.vpt_rcode = htole32(VCPROPTAG_REQUEST),
			},
			.enable = htole32((on != 0) ? 1 : 0),
			.x = htole32(x),
			.y = htole32(y),
			.flags = htole32(1),
		},
		.end = {
			.vpt_tag = htole32(VCPROPTAG_NULL),
		},
	};

	error = bcmmbox_request(BCMMBOX_CHANARM2VC, &vb_cursorstate,
	    sizeof(vb_cursorstate), &res);
#ifdef RPI_IOCTL_DEBUG
	printf("%s: %08x %d %08x %08x\n", __func__,
	    le32toh(vb_cursorstate.vbt_cs.enable), error, res,
	    le32toh(vb_cursorstate.vbt_cs.tag.vpt_rcode));
#endif
	if (error)
		return error;

	if (!vcprop_buffer_success_p(&vb_cursorstate.vb_hdr) ||
	    !vcprop_tag_success_p(&vb_cursorstate.vbt_cs.tag)) {
		return EIO;
	}

	return 0;
}

int
rpi_fb_initcursor(bus_addr_t pixels, int hx, int hy)
{
	int error;
	uint32_t res;


	struct __aligned(16) {
		struct vcprop_buffer_hdr	vb_hdr;
		struct vcprop_tag_cursorinfo	vbt_ci;
		struct vcprop_tag end;
	} vb_cursorinfo =
	{
		.vb_hdr = {
			.vpb_len = htole32(sizeof(vb_cursorinfo)),
			.vpb_rcode = htole32(VCPROP_PROCESS_REQUEST),
		},
		.vbt_ci = {
			.tag = {
				.vpt_tag = htole32(VCPROPTAG_SET_CURSOR_INFO),
				.vpt_len = htole32(VCPROPTAG_LEN(
				    vb_cursorinfo.vbt_ci)),
				.vpt_rcode = htole32(VCPROPTAG_REQUEST),
			},
			.width = htole32(64),
			.height = htole32(64),
			.format = htole32(0),
			.pixels = htole32(pixels),
			.hotspot_x = htole32(hx),
			.hotspot_y = htole32(hy),
		},
		.end = {
			.vpt_tag = htole32(VCPROPTAG_NULL),
		},
	};

	error = bcmmbox_request(BCMMBOX_CHANARM2VC, &vb_cursorinfo,
	    sizeof(vb_cursorinfo), &res);
#ifdef RPI_IOCTL_DEBUG
	printf("%s: %d %d %08x %08x\n", __func__,
	    le32toh(vb_cursorinfo.vbt_ci.width), error, res,
	    le32toh(vb_cursorinfo.vbt_ci.tag.vpt_rcode));
#endif
	if (error)
		return error;

	if (!vcprop_buffer_success_p(&vb_cursorinfo.vb_hdr) ||
	    !vcprop_tag_success_p(&vb_cursorinfo.vbt_ci.tag)) {
		return EIO;
	}

	return 0;
}

int
rpi_fb_get_pixelorder(uint32_t *orderp)
{
	int error;
	uint32_t res;


	struct __aligned(16) {
		struct vcprop_buffer_hdr	vb_hdr;
		struct vcprop_tag_fbpixelorder	vbt_po;
		struct vcprop_tag end;
	} vb_pixelorder =
	{
		.vb_hdr = {
			.vpb_len = htole32(sizeof(vb_pixelorder)),
			.vpb_rcode = htole32(VCPROP_PROCESS_REQUEST),
		},
		.vbt_po = {
			.tag = {
				.vpt_tag = htole32(VCPROPTAG_GET_FB_PIXEL_ORDER),
				.vpt_len = htole32(VCPROPTAG_LEN(
				    vb_pixelorder.vbt_po)),
				.vpt_rcode = htole32(VCPROPTAG_REQUEST),
			},
		},
		.end = {
			.vpt_tag = htole32(VCPROPTAG_NULL),
		},
	};

	error = bcmmbox_request(BCMMBOX_CHANARM2VC, &vb_pixelorder,
	    sizeof(vb_pixelorder), &res);
#ifdef RPI_IOCTL_DEBUG
	printf("%s: %d %d %08x %08x\n", __func__,
	    le32toh(vb_pixelorder.vbt_po.order), error, res,
	    le32toh(vb_pixelorder.vbt_po.tag.vpt_rcode));
#endif
	if (error)
		return error;

	if (!vcprop_buffer_success_p(&vb_pixelorder.vb_hdr) ||
	    !vcprop_tag_success_p(&vb_pixelorder.vbt_po.tag)) {
		return EIO;
	}

	*orderp = vb_pixelorder.vbt_po.order;

	return 0;
}

int
rpi_fb_set_pixelorder(uint32_t order)
{
	int error;
	uint32_t res;


	struct __aligned(16) {
		struct vcprop_buffer_hdr	vb_hdr;
		struct vcprop_tag_fbpixelorder	vbt_po;
		struct vcprop_tag end;
	} vb_pixelorder =
	{
		.vb_hdr = {
			.vpb_len = htole32(sizeof(vb_pixelorder)),
			.vpb_rcode = htole32(VCPROP_PROCESS_REQUEST),
		},
		.vbt_po = {
			.tag = {
				.vpt_tag = htole32(VCPROPTAG_SET_FB_PIXEL_ORDER),
				.vpt_len = htole32(VCPROPTAG_LEN(
				    vb_pixelorder.vbt_po)),
				.vpt_rcode = htole32(VCPROPTAG_REQUEST),
			},
			.order = order
		},
		.end = {
			.vpt_tag = htole32(VCPROPTAG_NULL),
		},
	};

	error = bcmmbox_request(BCMMBOX_CHANARM2VC, &vb_pixelorder,
	    sizeof(vb_pixelorder), &res);
#ifdef RPI_IOCTL_DEBUG
	printf("%s: %d %d %08x %08x\n", __func__,
	    le32toh(vb_pixelorder.vbt_po.order), error, res,
	    le32toh(vb_pixelorder.vbt_po.tag.vpt_rcode));
#endif
	if (error)
		return error;

	if (!vcprop_buffer_success_p(&vb_pixelorder.vb_hdr) ||
	    !vcprop_tag_success_p(&vb_pixelorder.vbt_po.tag)) {
		return EIO;
	}

	return 0;
}

int
rpi_set_domain(uint32_t domain, uint32_t state)
{
	int error;
	uint32_t tag, res;

	tag = VCPROPTAG_SET_DOMAIN_STATE;
	if (domain == VCPROP_DOMAIN_USB) {
		/* use old interface */
		tag = VCPROPTAG_SET_POWERSTATE;
		domain = VCPROP_POWER_USB;
	}

	/*
	 * might as well put it here since we need to re-init it every time
	 * and it's not like this is going to be called very often anyway
	 */
	struct __aligned(16) {
		struct vcprop_buffer_hdr	vb_hdr;
		struct vcprop_tag_powerstate	vbt_power;
		struct vcprop_tag end;
	} vb_setpower =
	{
		.vb_hdr = {
			.vpb_len = sizeof(vb_setpower),
			.vpb_rcode = VCPROP_PROCESS_REQUEST,
		},
		.vbt_power = {
			.tag = {
				.vpt_tag = tag,
				.vpt_len = VCPROPTAG_LEN(vb_setpower.vbt_power),
				.vpt_rcode = VCPROPTAG_REQUEST,
			},
			.id = domain,
			.state = state
		},
		.end = {
			.vpt_tag = VCPROPTAG_NULL,
		},
	};

	error = bcmmbox_request(BCMMBOX_CHANARM2VC, &vb_setpower,
	    sizeof(vb_setpower), &res);
#ifdef RPI_IOCTL_DEBUG
	printf("%s: %08x %08x %d %08x %08x %d %d %08x %08x\n", __func__,
	    tag, domain, state,
	    vb_setpower.vbt_power.tag.vpt_tag,
	    vb_setpower.vbt_power.id,
	    vb_setpower.vbt_power.state,
	    error, res,
	    vb_setpower.vbt_power.tag.vpt_rcode);
#endif
	if (error)
		return error;

	if (!vcprop_buffer_success_p(&vb_setpower.vb_hdr) ||
	    !vcprop_tag_success_p(&vb_setpower.vbt_power.tag)) {
		return EIO;
	}

	return 0;
}

int
rpi_get_domain(uint32_t domain, uint32_t *statep)
{
	int error;
	uint32_t tag, res;

	tag = VCPROPTAG_GET_DOMAIN_STATE;
	if (domain == VCPROP_DOMAIN_USB) {
		/* use old interface */
		tag = VCPROPTAG_GET_POWERSTATE;
		domain = VCPROP_POWER_USB;
	}

	/*
	 * might as well put it here since we need to re-init it every time
	 * and it's not like this is going to be called very often anyway
	 */
	struct __aligned(16) {
		struct vcprop_buffer_hdr	vb_hdr;
		struct vcprop_tag_powerstate	vbt_power;
		struct vcprop_tag end;
	} vb_setpower =
	{
		.vb_hdr = {
			.vpb_len = sizeof(vb_setpower),
			.vpb_rcode = VCPROP_PROCESS_REQUEST,
		},
		.vbt_power = {
			.tag = {
				.vpt_tag = tag,
				.vpt_len = VCPROPTAG_LEN(vb_setpower.vbt_power),
				.vpt_rcode = VCPROPTAG_REQUEST,
			},
			.id = domain,
			.state = ~0
		},
		.end = {
			.vpt_tag = VCPROPTAG_NULL,
		},
	};

	error = bcmmbox_request(BCMMBOX_CHANARM2VC, &vb_setpower,
	    sizeof(vb_setpower), &res);
#ifdef RPI_IOCTL_DEBUG
	printf("%s: %08x %08x %d %08x %08x %d %d %08x %08x\n", __func__,
	    tag, domain, *statep,
	    vb_setpower.vbt_power.tag.vpt_tag,
	    vb_setpower.vbt_power.id,
	    vb_setpower.vbt_power.state,
	    error, res,
	    vb_setpower.vbt_power.tag.vpt_rcode);
#endif
	if (error)
		return error;

	if (!vcprop_buffer_success_p(&vb_setpower.vb_hdr) ||
	    !vcprop_tag_success_p(&vb_setpower.vbt_power.tag)) {
		return EIO;
	}

	*statep = vb_setpower.vbt_power.state;

	return 0;
}

int
rpi_vchiq_init(uint32_t *channelbasep)
{
	int error;
	uint32_t tag, res;
	struct __aligned(16) {
		struct vcprop_buffer_hdr	vb_hdr;
		struct vcprop_tag_vchiqinit	vbt_vchiq;
		struct vcprop_tag end;
	} vb;

	tag = VCPROPTAG_VCHIQ_INIT;

	VCPROP_INIT_REQUEST(vb);
	VCPROP_INIT_TAG(vb.vbt_vchiq, tag);
	vb.vbt_vchiq.base = *channelbasep;

	error = bcmmbox_request(BCMMBOX_CHANARM2VC, &vb, sizeof(vb), &res);
	if (error)
		return error;

	if (!vcprop_buffer_success_p(&vb.vb_hdr) ||
	    !vcprop_tag_success_p(&vb.vbt_vchiq.tag)) {
		return EIO;
	}
	*channelbasep = vb.vbt_vchiq.base;

	return 0;
}

int
rpi_notify_xhci_reset(uint32_t address)
{
	int error;
	uint32_t tag, res;
	struct __aligned(16) {
		struct vcprop_buffer_hdr	vb_hdr;
		struct vcprop_tag_notifyxhcireset	vbt_nhr;
		struct vcprop_tag end;
	} vb;

	tag = VCPROPTAG_NOTIFY_XHCI_RESET;

	VCPROP_INIT_REQUEST(vb);
	VCPROP_INIT_TAG(vb.vbt_nhr, tag);
	vb.vbt_nhr.deviceaddress = address;

	error = bcmmbox_request(BCMMBOX_CHANARM2VC, &vb, sizeof(vb), &res);
	if (error)
		return error;

	if (!vcprop_buffer_success_p(&vb.vb_hdr) ||
	    !vcprop_tag_success_p(&vb.vbt_nhr.tag)) {
		return EIO;
	}

	return 0;
}