#include <syslog.h>
#include <stdio.h>
#include <sys/types.h>
#include <sys/ipc.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <sys/socket.h>
#include <sys/ipc.h>
#include <sys/shm.h>
#include <sys/sem.h>
#include <wait.h>
#include <time.h>
#include <synch.h>
#include <netinet/in.h>
#include <thread.h>
#include <signal.h>
#include "vntsd.h"
boolean_t
vntsd_notify_client_cons_del(vntsd_client_t *clientp)
{
(void) mutex_lock(&clientp->lock);
clientp->status |= VNTSD_CLIENT_CONS_DELETED;
(void) thr_kill(clientp->cons_tid, SIGUSR1);
(void) mutex_unlock(&clientp->lock);
return (B_FALSE);
}
static void
free_cons(vntsd_cons_t *consp)
{
assert(consp);
(void) mutex_destroy(&consp->lock);
(void) cond_destroy(&consp->cvp);
if (consp->vcc_fd != -1)
(void) close(consp->vcc_fd);
free(consp);
}
static void
free_group(vntsd_group_t *groupp)
{
assert(groupp);
(void) mutex_destroy(&groupp->lock);
(void) cond_destroy(&groupp->cvp);
if (groupp->sockfd != -1)
(void) close(groupp->sockfd);
free(groupp);
}
static void
cleanup_cons(vntsd_cons_t *consp)
{
vntsd_group_t *groupp;
timestruc_t to;
assert(consp);
D1(stderr, "t@%d vntsd_disconn_clients@%d\n", thr_self(),
consp->cons_no);
groupp = consp->group;
assert(groupp);
(void) mutex_lock(&consp->lock);
while (consp->clientpq != NULL) {
consp->status |= VNTSD_CONS_SIG_WAIT;
(void) vntsd_que_walk(consp->clientpq,
(el_func_t)vntsd_notify_client_cons_del);
(void) thr_kill(consp->wr_tid, SIGUSR1);
to.tv_sec = VNTSD_CV_WAIT_DELTIME;
to.tv_nsec = 0;
(void) cond_reltimedwait(&consp->cvp, &consp->lock, &to);
}
(void) mutex_lock(&groupp->lock);
assert(groupp->num_cons > 0);
groupp->num_cons--;
(void) mutex_unlock(&groupp->lock);
(void) mutex_unlock(&consp->lock);
free_cons(consp);
}
static boolean_t
find_clean_cons_group(vntsd_group_t *groupp)
{
if (groupp->status & VNTSD_GROUP_CLEAN_CONS) {
return (B_TRUE);
} else {
return (B_FALSE);
}
}
static boolean_t
find_clean_cons(vntsd_cons_t *consp)
{
if (consp->status & VNTSD_CONS_DELETED) {
return (B_TRUE);
} else {
return (B_FALSE);
}
}
void
vntsd_delete_cons(vntsd_t *vntsdp)
{
vntsd_group_t *groupp;
vntsd_cons_t *consp;
for (; ; ) {
(void) mutex_lock(&vntsdp->lock);
groupp = vntsd_que_walk(vntsdp->grouppq,
(el_func_t)find_clean_cons_group);
if (groupp == NULL) {
(void) mutex_unlock(&vntsdp->lock);
return;
}
(void) mutex_lock(&groupp->lock);
groupp->status &= ~VNTSD_GROUP_CLEAN_CONS;
(void) mutex_unlock(&groupp->lock);
(void) mutex_unlock(&vntsdp->lock);
for (; ; ) {
(void) mutex_lock(&groupp->lock);
if (groupp->conspq != NULL) {
consp = vntsd_que_walk(groupp->conspq,
(el_func_t)find_clean_cons);
if (consp == NULL) {
(void) mutex_unlock(&groupp->lock);
break;
}
(void) vntsd_que_rm(&groupp->conspq, consp);
(void) mutex_unlock(&groupp->lock);
cleanup_cons(consp);
}
if (groupp->conspq == NULL) {
assert(groupp->vntsd);
(void) mutex_lock(&groupp->vntsd->lock);
(void) vntsd_que_rm(&groupp->vntsd->grouppq,
groupp);
(void) mutex_unlock(&groupp->vntsd->lock);
vntsd_clean_group(groupp);
break;
}
}
}
}
void
vntsd_clean_group(vntsd_group_t *groupp)
{
timestruc_t to;
D1(stderr, "t@%d clean_group() group=%s tcp=%lld\n", thr_self(),
groupp->group_name, groupp->tcp_port);
(void) mutex_lock(&groupp->lock);
if (groupp->status & VNTSD_GROUP_IN_CLEANUP) {
(void) mutex_unlock(&groupp->lock);
return;
}
groupp->status |= VNTSD_GROUP_IN_CLEANUP;
groupp->status |= VNTSD_GROUP_SIG_WAIT;
(void) mutex_unlock(&groupp->lock);
vntsd_free_que(&groupp->conspq, (clean_func_t)cleanup_cons);
(void) mutex_lock(&groupp->lock);
while (groupp->no_cons_clientpq != NULL) {
(void) vntsd_que_walk(groupp->no_cons_clientpq,
(el_func_t)vntsd_notify_client_cons_del);
to.tv_sec = VNTSD_CV_WAIT_DELTIME;
to.tv_nsec = 0;
(void) cond_reltimedwait(&groupp->cvp, &groupp->lock, &to);
}
while (groupp->status & VNTSD_GROUP_SIG_WAIT) {
(void) thr_kill(groupp->listen_tid, SIGUSR1);
to.tv_sec = VNTSD_CV_WAIT_DELTIME;
to.tv_nsec = 0;
(void) cond_reltimedwait(&groupp->cvp, &groupp->lock, &to);
}
(void) mutex_unlock(&groupp->lock);
(void) thr_join(groupp->listen_tid, NULL, NULL);
free_group(groupp);
}
static vntsd_cons_t *
alloc_cons(vntsd_group_t *groupp, vcc_console_t *consolep)
{
vntsd_cons_t *consp;
int rv;
consp = (vntsd_cons_t *)malloc(sizeof (vntsd_cons_t));
if (consp == NULL) {
vntsd_log(VNTSD_ERR_NO_MEM, "alloc_cons");
return (NULL);
}
bzero(consp, sizeof (vntsd_cons_t));
(void) mutex_init(&consp->lock, USYNC_THREAD|LOCK_ERRORCHECK, NULL);
(void) cond_init(&consp->cvp, USYNC_THREAD, NULL);
consp->cons_no = consolep->cons_no;
(void) strlcpy(consp->domain_name, consolep->domain_name, MAXPATHLEN);
(void) strlcpy(consp->dev_name, consolep->dev_name, MAXPATHLEN);
consp->wr_tid = (thread_t)-1;
consp->vcc_fd = -1;
(void) mutex_lock(&groupp->lock);
if ((rv = vntsd_que_append(&groupp->conspq, consp)) !=
VNTSD_SUCCESS) {
(void) mutex_unlock(&groupp->lock);
vntsd_log(rv, "alloc_cons");
free_cons(consp);
return (NULL);
}
groupp->num_cons++;
consp->group = groupp;
(void) mutex_unlock(&groupp->lock);
D1(stderr, "t@%d alloc_cons@%d %s %s\n", thr_self(),
consp->cons_no, consp->domain_name, consp->dev_name);
return (consp);
}
static boolean_t
grp_by_tcp(vntsd_group_t *groupp, uint64_t *tcp_port)
{
assert(groupp);
assert(tcp_port);
return (groupp->tcp_port == *tcp_port);
}
static vntsd_group_t *
alloc_group(vntsd_t *vntsdp, char *group_name, uint64_t tcp_port)
{
vntsd_group_t *groupp;
groupp = (vntsd_group_t *)malloc(sizeof (vntsd_group_t));
if (groupp == NULL) {
vntsd_log(VNTSD_ERR_NO_MEM, "alloc_group");
return (NULL);
}
bzero(groupp, sizeof (vntsd_group_t));
(void) mutex_init(&groupp->lock, USYNC_THREAD|LOCK_ERRORCHECK, NULL);
(void) cond_init(&groupp->cvp, USYNC_THREAD, NULL);
if (group_name != NULL) {
(void) memcpy(groupp->group_name, group_name, MAXPATHLEN);
}
groupp->tcp_port = tcp_port;
groupp->listen_tid = (thread_t)-1;
groupp->sockfd = -1;
groupp->vntsd = vntsdp;
D1(stderr, "t@%d alloc_group@%lld:%s\n", thr_self(), groupp->tcp_port,
groupp->group_name);
return (groupp);
}
boolean_t
vntsd_mark_deleted_cons(vntsd_cons_t *consp)
{
(void) mutex_lock(&consp->lock);
consp->status |= VNTSD_CONS_DELETED;
(void) mutex_unlock(&consp->lock);
return (B_FALSE);
}
static int
alloc_cons_with_group(vntsd_t *vntsdp, vcc_console_t *consp,
vntsd_group_t **new_groupp)
{
vntsd_group_t *groupp = NULL;
int rv;
*new_groupp = NULL;
(void) mutex_lock(&vntsdp->lock);
groupp = vntsd_que_find(vntsdp->grouppq,
(compare_func_t)grp_by_tcp, (void *)&(consp->tcp_port));
if (groupp != NULL)
(void) mutex_lock(&groupp->lock);
(void) mutex_unlock(&vntsdp->lock);
if (groupp != NULL) {
if (vntsd_chk_group_total_cons(groupp) == 0) {
(void) vntsd_que_walk(groupp->conspq,
(el_func_t)vntsd_mark_deleted_cons);
groupp->status |= VNTSD_GROUP_CLEAN_CONS;
(void) mutex_unlock(&groupp->lock);
groupp = NULL;
} else if (strcmp(groupp->group_name, consp->group_name)) {
vntsd_log(VNTSD_ERR_VCC_GRP_NAME,
"group name is different from existing group");
(void) mutex_unlock(&groupp->lock);
return (VNTSD_ERR_VCC_CTRL_DATA);
} else {
(void) mutex_unlock(&groupp->lock);
}
}
if (groupp == NULL) {
groupp = alloc_group(vntsdp, consp->group_name,
consp->tcp_port);
if (groupp == NULL) {
return (VNTSD_ERR_NO_MEM);
}
assert(groupp->conspq == NULL);
(void) mutex_lock(&vntsdp->lock);
rv = vntsd_que_append(&vntsdp->grouppq, groupp);
(void) mutex_unlock(&vntsdp->lock);
if (rv != VNTSD_SUCCESS) {
return (rv);
}
*new_groupp = groupp;
}
if (alloc_cons(groupp, consp) == NULL) {
if (*new_groupp != NULL) {
free_group(groupp);
}
return (VNTSD_ERR_NO_MEM);
}
return (VNTSD_SUCCESS);
}
static boolean_t
create_listen_thread(vntsd_group_t *groupp)
{
char err_msg[VNTSD_LINE_LEN];
int rv;
assert(groupp);
(void) mutex_lock(&groupp->lock);
assert(groupp->num_cons);
D1(stderr, "t@%d create_listen:%lld\n", thr_self(), groupp->tcp_port);
if ((rv = thr_create(NULL, 0, (thr_func_t)vntsd_listen_thread,
(void *)groupp, THR_DETACHED, &groupp->listen_tid)) != 0) {
(void) (void) snprintf(err_msg, sizeof (err_msg),
"Can not create listen thread for"
"group %s tcp %llx\n", groupp->group_name,
groupp->tcp_port);
vntsd_log(VNTSD_ERR_CREATE_LISTEN_THR, err_msg);
vntsd_free_que(&groupp->conspq, (clean_func_t)free_cons);
groupp->listen_tid = (thread_t)-1;
}
(void) mutex_unlock(&groupp->lock);
return (rv != 0);
}
static boolean_t
deleted_cons_by_consno(vntsd_cons_t *consp, int *cons_no)
{
vntsd_client_t *clientp;
assert(consp);
if (consp->cons_no != *cons_no)
return (B_FALSE);
if ((consp->status & VNTSD_CONS_DELETED) == 0)
return (B_TRUE);
if (consp->clientpq == NULL)
return (B_TRUE);
clientp = (vntsd_client_t *)consp->clientpq->handle;
if (clientp->status & VNTSD_CLIENT_CONS_DELETED)
return (B_FALSE);
return (B_TRUE);
}
static boolean_t
find_cons_group_by_cons_no(vntsd_group_t *groupp, uint_t *cons_no)
{
vntsd_cons_t *consp;
consp = vntsd_que_find(groupp->conspq,
(compare_func_t)deleted_cons_by_consno, cons_no);
return (consp != NULL);
}
static void
delete_cons_before_add(vntsd_t *vntsdp, uint_t cons_no)
{
vntsd_group_t *groupp;
vntsd_cons_t *consp;
(void) mutex_lock(&vntsdp->lock);
groupp = vntsd_que_find(vntsdp->grouppq,
(compare_func_t)find_cons_group_by_cons_no,
&cons_no);
(void) mutex_unlock(&vntsdp->lock);
if (groupp == NULL) {
return;
}
(void) mutex_lock(&groupp->lock);
consp = vntsd_que_find(groupp->conspq,
(compare_func_t)deleted_cons_by_consno, &cons_no);
if (consp == NULL) {
(void) mutex_unlock(&groupp->lock);
return;
}
(void) mutex_lock(&consp->lock);
if (consp->status & VNTSD_CONS_DELETED) {
(void) mutex_unlock(&consp->lock);
(void) mutex_unlock(&groupp->lock);
return;
}
consp->status |= VNTSD_CONS_DELETED;
groupp->status |= VNTSD_GROUP_CLEAN_CONS;
(void) mutex_unlock(&consp->lock);
(void) mutex_unlock(&groupp->lock);
}
static void
do_add_cons(vntsd_t *vntsdp, int cons_no)
{
vcc_console_t console;
vntsd_group_t *groupp;
int rv;
char err_msg[VNTSD_LINE_LEN];
(void) snprintf(err_msg, sizeof (err_msg),
"do_add_cons():Can not add console=%d", cons_no);
if ((rv = vntsd_vcc_ioctl(VCC_CONS_INFO, cons_no, (void *)&console))
!= VNTSD_SUCCESS) {
vntsd_log(rv, err_msg);
return;
}
delete_cons_before_add(vntsdp, console.cons_no);
if ((rv = alloc_cons_with_group(vntsdp, &console, &groupp)) !=
VNTSD_SUCCESS) {
vntsd_log(rv, err_msg);
return;
}
if (groupp != NULL) {
if (create_listen_thread(groupp)) {
vntsd_log(VNTSD_ERR_CREATE_LISTEN_THR, err_msg);
free_group(groupp);
}
}
}
void
vntsd_daemon_wakeup(vntsd_t *vntsdp)
{
vcc_response_t inq_data;
if (vntsd_vcc_ioctl(VCC_INQUIRY, 0, (void *)&inq_data) !=
VNTSD_SUCCESS) {
vntsd_log(VNTSD_ERR_VCC_IOCTL, "vntsd_daemon_wakeup()");
return;
}
D1(stderr, "t@%d vntsd_daemon_wakup:msg %d port %x\n", thr_self(),
inq_data.reason, inq_data.cons_no);
switch (inq_data.reason) {
case VCC_CONS_ADDED:
do_add_cons(vntsdp, inq_data.cons_no);
break;
case VCC_CONS_MISS_ADDED:
return;
default:
DERR(stderr, "t@%d daemon_wakeup:ioctl_unknown %d\n",
thr_self(), inq_data.reason);
vntsd_log(VNTSD_ERR_UNKNOWN_CMD, "from vcc\n");
break;
}
}
void
vntsd_get_config(vntsd_t *vntsdp)
{
int i;
int num_cons;
vcc_console_t *consp;
vntsd_group_t *groupp;
num_cons = 0;
if (vntsd_vcc_ioctl(VCC_NUM_CONSOLE, 0, (void *)&num_cons) !=
VNTSD_SUCCESS) {
vntsd_log(VNTSD_ERR_VCC_IOCTL, "VCC_NUM_CONSOLE failed\n");
return;
}
D3(stderr, "get_config:num_cons=%d", num_cons);
if (num_cons == 0) {
return;
}
consp = malloc(num_cons*sizeof (vcc_console_t));
if (consp == NULL) {
vntsd_log(VNTSD_ERR_NO_MEM, "for console table.");
return;
}
if (vntsd_vcc_ioctl(VCC_CONS_TBL, 0, (void *)consp) != VNTSD_SUCCESS) {
vntsd_log(VNTSD_ERR_VCC_IOCTL, " VCC_CONS_TBL "
"for console table\n");
return;
}
for (i = 0; i < num_cons; i++) {
if (alloc_cons_with_group(vntsdp, &consp[i], &groupp)
!= VNTSD_SUCCESS) {
vntsd_log(VNTSD_ERR_ADD_CONS_FAILED, "get_config");
}
}
(void) mutex_lock(&vntsdp->lock);
for (; ; ) {
groupp = vntsd_que_walk(vntsdp->grouppq,
(el_func_t)create_listen_thread);
if (groupp == NULL) {
break;
}
vntsd_log(VNTSD_ERR_CREATE_LISTEN_THR, "get config()");
}
(void) mutex_unlock(&vntsdp->lock);
}