Initial commit of OpenSPARC T2 architecture model.

[OpenSPARC-T2-SAM] / hypervisor / src / greatlakes / common / src / svc_init.c

/*
* ========== Copyright Header Begin ==========================================
*
* Hypervisor Software File: svc_init.c
* 
* Copyright (c) 2006 Sun Microsystems, Inc. All Rights Reserved.
* 
*  - Do no alter or remove copyright notices
* 
*  - Redistribution and use of this software in source and binary forms, with 
*    or without modification, are permitted provided that the following 
*    conditions are met: 
* 
*  - Redistribution of source code must retain the above copyright notice, 
*    this list of conditions and the following disclaimer.
* 
*  - Redistribution 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. 
* 
*    Neither the name of Sun Microsystems, Inc. or the names of contributors 
* may be used to endorse or promote products derived from this software 
* without specific prior written permission. 
* 
*     This software is provided "AS IS," without a warranty of any kind. 
* ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND WARRANTIES, 
* INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY, FITNESS FOR A 
* PARTICULAR PURPOSE OR NON-INFRINGEMENT, ARE HEREBY EXCLUDED. SUN 
* MICROSYSTEMS, INC. ("SUN") AND ITS LICENSORS SHALL NOT BE LIABLE FOR 
* ANY DAMAGES SUFFERED BY LICENSEE AS A RESULT OF USING, MODIFYING OR 
* DISTRIBUTING THIS SOFTWARE OR ITS DERIVATIVES. IN NO EVENT WILL SUN 
* OR ITS LICENSORS BE LIABLE FOR ANY LOST REVENUE, PROFIT OR DATA, OR 
* FOR DIRECT, INDIRECT, SPECIAL, CONSEQUENTIAL, INCIDENTAL OR PUNITIVE 
* DAMAGES, HOWEVER CAUSED AND REGARDLESS OF THE THEORY OF LIABILITY, 
* ARISING OUT OF THE USE OF OR INABILITY TO USE THIS SOFTWARE, EVEN IF 
* SUN HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGES.
* 
* You acknowledge that this software is not designed, licensed or
* intended for use in the design, construction, operation or maintenance of
* any nuclear facility. 
* 
* ========== Copyright Header End ============================================
*/
/*
 * Copyright 2007 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 */

#pragma ident	"@(#)svc_init.c	1.4	07/08/14 SMI"

#ifdef CONFIG_SVC
#include  <stdarg.h>
#include  <sys/htypes.h>
#include  <vdev_ops.h>
#include  <vdev_intr.h>
#include  <ncs.h>
#include  <cyclic.h>
#include  <vcpu.h>
#include  <strand.h>
#include  <guest.h>
#include  <md.h>
#include  <debug.h>

#include <svc.h>
#include <svc_vbsc.h>


static uint64_t
c_svc_register(uint64_t cookie, uint64_t xid, uint64_t sid, uint64_t recv,
uint64_t send)
{
	hv_svc_data_t	*r_svcp = config.svc;

	if (r_svcp != NULL) {
		svc_ctrl_t	*r_svcsp = r_svcp->svcs;
		int	i;

		/* for the requested services */
		for (i = r_svcp->num_svcs; i > 0; i--, r_svcsp++) {

			if ((r_svcsp->xid == xid) && (r_svcsp->sid == sid)) {
				/*
				 * attach the callbacks to this service
				 * Ensure intrs are disabled on the channel
				 * and set the CALLBACK flag in both the svc
				 * config and state variables
				 */
				r_svcsp->config |= SVC_CFG_CALLBACK;
				r_svcsp->state |= SVC_CFG_CALLBACK;
				r_svcsp->callback.rx = (uint64_t)recv;
				r_svcsp->callback.tx = (uint64_t)send;
				r_svcsp->callback.cookie = cookie;
				return ((uint64_t)r_svcsp);
			}
		}
	}
	return (0);
}

/*
 * c_setup_err_svc - setup error service channel
 */
static void
c_setup_err_svc()
{
	uint64_t	rv;
	strand_t	*sp = c_mystrand();

	rv = c_svc_register((uint64_t)sp, XPID_HV, SID_ERROR,
	    (uint64_t)error_svc_rx, (uint64_t)error_svc_tx);

	if (rv == 0) {
		DBGINIT(c_printf("WARNING:c_setup_err_svc register fail\r\n"));
	}
	config.error_svch = rv;
}

#ifdef CONFIG_VBSC_SVC

/*
 * c_setup_vbsc_svc - setup vbsc service channel
 */
static void
c_setup_vbsc_svc()
{
	uint64_t	rv;
	strand_t	*sp = c_mystrand();

	/* Put error_svc handle into the debug structure */
	config.vbsc_dbgerror.error_svch = config.error_svch;

	rv = c_svc_register((uint64_t)sp, XPID_HV, SID_VBSC_CTL,
	    (uint64_t)vbsc_rx, (uint64_t)vbsc_tx);

	if (rv) {
		config.vbsc_svch = rv;
	} else {
		c_hvabort(-1);
	}
}

/*
 * c_vbsc_send_polled - send a vbsc command and poll for response
 */
static void
c_vbsc_send_polled(uint64_t cmd1, uint64_t cmd2, uint64_t cmd3)
{
	uint16_t		fpga_cmd_offset;
	volatile uint8_t	*fpga_statusp;
	uint16_t		*fpga_basep;
	uint64_t		*fpga_cmdp;
	uint8_t			fpga_cmd_status;

c_vbsc_send_polled_resend:
	fpga_basep = (uint16_t *)(FPGA_Q3OUT_BASE);
	fpga_statusp = (uint8_t *)fpga_basep;

	fpga_cmdp = (uint64_t *)(FPGA_BASE + FPGA_SRAM_BASE);
	fpga_cmd_offset = *((uint16_t *)((uint64_t)fpga_basep + FPGA_Q_BASE));

	/* sram buffer words */
	fpga_cmdp = (uint64_t *)((uint64_t)fpga_cmdp +
	    (uint64_t)fpga_cmd_offset);

	/* insert the command bytes */
	*(fpga_cmdp + 2) = cmd3;
	*(fpga_cmdp + 1) = cmd2;
	*(fpga_cmdp + 0) = cmd1;

	/* initiate the command */
	*((uint8_t *)((uint64_t)fpga_statusp + FPGA_Q_SEND)) = 1;

	/*
	 * Wait for a non-zero status.  If we get an ACK then we're done.
	 * Otherwise re-send the packet.  Failure is not an option, even
	 * to hv_abort we need to send a message to vbsc.  So keep trying.
	 */
	fpga_statusp = (uint8_t *)((uint64_t)fpga_statusp + FPGA_Q_STATUS);
	do {
		fpga_cmd_status = *fpga_statusp;
		fpga_cmd_status &= (QINTR_ACK | QINTR_NACK | QINTR_BUSY
		    | QINTR_ABORT);
	} while (fpga_cmd_status == 0);

	if (fpga_cmd_status & QINTR_ACK) {
		*fpga_statusp = fpga_cmd_status;	/* ack the command */
	} else {
		goto c_vbsc_send_polled_resend;
	}
}

/*
 *  c_vbsc_guest_start - send a message indicating guest is starting
 */
void
c_vbsc_guest_start(uint64_t gid)
{
	guest_t	 *guestp = (guest_t *)config.guests;

	guestp = &(guestp[gid]);

	c_vbsc_send_polled(VBSC_GUEST_ON, guestp->guestid + XPID_GUESTBASE, 0);
}
#endif /* CONFIG_VBSC_SVC */


/*
 * c_svc_init - initialize the service channels
 */
void
c_svc_init()
{
	hv_svc_data_t	*r_svcp = config.svc;
	svc_ctrl_t	*r_svcsp = r_svcp->svcs;
	int		i;

	/* for each of the configured services */
	for (i = r_svcp->num_svcs; i > 0; i--, r_svcsp++) {

		/* if there is an RCV or XMT configured */
		if (r_svcsp->config & (SVC_CFG_RE | SVC_CFG_TE)) {

			if (r_svcsp->xid >= XPID_GUESTBASE) {
				guest_t	 *guestp = (guest_t *)config.guests;

				/* determine the guest for this service */
				guestp = &(guestp[r_svcsp->xid-XPID_GUESTBASE]);

				/* register the interrupt; save the cookie */
				r_svcsp->intr_cookie = c_vdev_intr_register(
				    guestp, r_svcsp->ino, r_svcsp,
				    svc_intr_getstate, (intr_setstate_f)NULL);
			}
		}
	}

#ifdef CONFIG_FPGA
	/*
	 * Mailbox hardware initialization
	 */
	{
		volatile uint8_t	*fpgap;
		uint8_t			tmp;

		/* Clear previously-pending state */
		fpgap = (uint8_t *)(FPGA_Q_BASE + FPGA_Q_STATUS);
		tmp = *fpgap;
		*fpgap = tmp;

		/* Enable interrupts */
		fpgap = (uint8_t *)(FPGA_INTR_BASE + FPGA_MBOX_INTR_ENABLE);
		*fpgap = (IRQ_QUEUE_IN|IRQ_QUEUE_OUT|IRQ_LDC_OUT);
	}
#endif /* CONFIG_FPGA */

	/* Must be before setup_vbsc_svc */
	c_setup_err_svc();

#ifdef CONFIG_VBSC_SVC
	DBGINIT(c_printf("c_svc_init: setup vbsc_svc\n"));
	c_setup_vbsc_svc();
#endif /* CONFIG_VBSC_SVC */
}
#endif /* CONFIG_SVC */