/*
* CDDL HEADER START
*
* The contents of this file are subject to the terms of the
* Common Development and Distribution License, Version 1.0 only
* (the "License"). You may not use this file except in compliance
* with the License.
*
* You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
* or http://www.opensolaris.org/os/licensing.
* See the License for the specific language governing permissions
* and limitations under the License.
*
* When distributing Covered Code, include this CDDL HEADER in each
* file and include the License file at usr/src/OPENSOLARIS.LICENSE.
* If applicable, add the following below this CDDL HEADER, with the
* fields enclosed by brackets "[]" replaced with your own identifying
* information: Portions Copyright [yyyy] [name of copyright owner]
*
* CDDL HEADER END
*/
/*
* Copyright 2002 Sun Microsystems, Inc. All rights reserved.
* Use is subject to license terms.
*/
/*
* smq.c: to provide a message queue system for scadm functions (used in the
* firmware download context where BP messages, received from the service
* processor, are stored in the message queue)
*
* these routines come from the libxposix library
*/
#include <sys/types.h>
#include <time.h>
#include "xsem.h"
#include "smq.h"
#define SMQ_VALID_SMQ 0x0000003b
#define SMQ_VALID_SMQ_MASK 0x000000FF
int
smq_init(smq_t *smq, smq_msg_t *msgbuffer, int depth)
{
/* allocate local semaphore initialized to 0 */
if (xsem_init(&smq->smq_msgAvail, 0, 0) != 0)
return (SMQ_ERROR);
smq->smq_control = SMQ_VALID_SMQ;
smq->smq_msgBuffer = msgbuffer;
smq->smq_head = msgbuffer;
smq->smq_tail = msgbuffer;
smq->smq_count = 0;
smq->smq_depth = depth;
return (0);
}
int
smq_destroy(smq_t *smq)
{
if ((smq->smq_control & SMQ_VALID_SMQ_MASK) != SMQ_VALID_SMQ)
return (SMQ_INVALID);
smq->smq_control = 0;
(void) xsem_destroy(&smq->smq_msgAvail);
return (0);
}
int
smq_receive(smq_t *smq, smq_msg_t *msg)
{
if ((smq->smq_control & SMQ_VALID_SMQ_MASK) != SMQ_VALID_SMQ)
return (SMQ_INVALID);
/* Wait for message */
(void) xsem_wait(&smq->smq_msgAvail);
if (smq->smq_count == 0)
return (SMQ_ERROR);
/* Copy messaged into queue */
*msg = *smq->smq_head;
smq->smq_head++;
if ((unsigned long)smq->smq_head > ((unsigned long)smq->smq_msgBuffer +
(unsigned long)(smq->smq_depth * sizeof (smq_msg_t)))) {
smq->smq_head = smq->smq_msgBuffer;
}
smq->smq_count--;
return (0);
}
int
smq_send(smq_t *smq, smq_msg_t *msg)
{
if ((smq->smq_control & SMQ_VALID_SMQ_MASK) != SMQ_VALID_SMQ)
return (SMQ_INVALID);
if (smq->smq_count == smq->smq_depth)
return (SMQ_FULL);
/* Copy messaged into queue */
*smq->smq_tail = *msg;
smq->smq_tail++;
if ((unsigned long)smq->smq_tail > ((unsigned long)smq->smq_msgBuffer +
(unsigned long)(smq->smq_depth * sizeof (smq_msg_t)))) {
smq->smq_tail = smq->smq_msgBuffer;
}
smq->smq_count++;
(void) xsem_post(&smq->smq_msgAvail);
return (0);
}
int
smq_pendingmsgs(smq_t *smq, int *num)
{
if ((smq->smq_control & SMQ_VALID_SMQ_MASK) != SMQ_VALID_SMQ)
return (SMQ_INVALID);
*num = smq->smq_count;
return (0);
}
int
smq_depth(smq_t *smq, int *depth)
{
if ((smq->smq_control & SMQ_VALID_SMQ_MASK) != SMQ_VALID_SMQ)
return (SMQ_INVALID);
*depth = smq->smq_depth;
return (0);
}
int
smq_xreceive(smq_t *smq, timestruc_t *timeout, smq_msg_t *msg)
{
int Status;
if ((smq->smq_control & SMQ_VALID_SMQ_MASK) != SMQ_VALID_SMQ)
return (SMQ_INVALID);
/* Wait for message */
if ((Status = xsem_xwait(&smq->smq_msgAvail, 1, timeout)) == XSEM_ETIME)
return (SMQ_ETIME);
if (Status != 0)
return (SMQ_ERROR);
if (smq->smq_count == 0)
return (SMQ_ERROR);
/* Copy messaged into queue */
*msg = *smq->smq_head;
smq->smq_head++;
if ((unsigned long)smq->smq_head > ((unsigned long)smq->smq_msgBuffer +
(unsigned long)(smq->smq_depth * sizeof (smq_msg_t)))) {
smq->smq_head = smq->smq_msgBuffer;
}
smq->smq_count--;
return (0);
}