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