Home | History | Annotate | Line # | Download | only in intrctl
intrctl_io.c revision 1.3 
      1 /*	$NetBSD: intrctl_io.c,v 1.3 2016/08/05 06:58:55 knakahara Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 2015 Internet Initiative Japan Inc.
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  *
     16  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  * POSSIBILITY OF SUCH DAMAGE.
     27  */
     28 
     29 #include <sys/cdefs.h>
     30 __RCSID("$NetBSD: intrctl_io.c,v 1.3 2016/08/05 06:58:55 knakahara Exp $");
     31 
     32 #include <sys/sysctl.h>
     33 #include <sys/intrio.h>
     34 
     35 #include <errno.h>
     36 #include <stdio.h>
     37 #include <stdlib.h>
     38 
     39 #include "intrctl_io.h"
     40 
     41 /*
     42  * To support increasing the number of interrupts (devices are dynamically
     43  * attached), retry sysctl(3) "retry" times.
     44  */
     45 void *
     46 intrctl_io_alloc(int retry)
     47 {
     48 	size_t buf_size;
     49 	int i, error;
     50 	void *buf = NULL;
     51 
     52 	error = sysctlbyname("kern.intr.list", NULL, &buf_size, NULL, 0);
     53 	if (error < 0) {
     54 		goto error;
     55 	}
     56 
     57 	buf = malloc(buf_size);
     58 	if (buf == NULL) {
     59 		goto error;
     60 	}
     61 
     62 	for (i = 0; i < retry; i++) {
     63 		error = sysctlbyname("kern.intr.list", buf, &buf_size, NULL, 0);
     64 		if (error >= 0)
     65 			return buf;
     66 		else if (errno == ENOMEM) {
     67 			void *temp;
     68 
     69 			temp = realloc(buf, buf_size);
     70 			if (temp == NULL) {
     71 				goto error;
     72 			}
     73 			buf = temp;
     74 		} else {
     75 			goto error;
     76 		}
     77 	}
     78 error:
     79 	if (buf != NULL)
     80 		free(buf);
     81 	return NULL;
     82 }
     83 
     84 void
     85 intrctl_io_free(void *handle)
     86 {
     87 
     88 	free(handle);
     89 }
     90 
     91 int
     92 intrctl_io_ncpus(void *handle)
     93 {
     94 	struct intrio_list *list = handle;
     95 
     96 	return list->il_ncpus;
     97 }
     98 
     99 int
    100 intrctl_io_nintrs(void *handle)
    101 {
    102 	struct intrio_list *list = handle;
    103 
    104 	return list->il_nintrs;
    105 }
    106 
    107 struct intrio_list_line *
    108 intrctl_io_firstline(void *handle)
    109 {
    110 	struct intrio_list *list = handle;
    111 
    112 	return (struct intrio_list_line *)((char *)list + list->il_lineoffset);
    113 }
    114 
    115 struct intrio_list_line *
    116 intrctl_io_nextline(void *handle, struct intrio_list_line *cur)
    117 {
    118 	struct intrio_list *list;
    119 	struct intrio_list_line *next;
    120 	size_t line_size;
    121 	char *buf_end;
    122 
    123 	list = handle;
    124 	buf_end = (char *)list + list->il_bufsize;
    125 
    126 	line_size = list->il_linesize;
    127 	next = (struct intrio_list_line *)((char *)cur + line_size);
    128 	if ((char *)next >= buf_end)
    129 		return NULL;
    130 
    131 	return next;
    132 }
    133