[BACK]Return to fifo_vnops.c CVS log [TXT][DIR] Up to [local] / prex / usr / server / fs / fifofs

Annotation of prex/usr/server/fs/fifofs/fifo_vnops.c, Revision 1.1.1.1

1.1       nbrk        1: /*
                      2:  * Copyright (c) 2008, Kohsuke Ohtani
                      3:  * All rights reserved.
                      4:  *
                      5:  * Redistribution and use in source and binary forms, with or without
                      6:  * modification, are permitted provided that the following conditions
                      7:  * are met:
                      8:  * 1. Redistributions of source code must retain the above copyright
                      9:  *    notice, this list of conditions and the following disclaimer.
                     10:  * 2. Redistributions in binary form must reproduce the above copyright
                     11:  *    notice, this list of conditions and the following disclaimer in the
                     12:  *    documentation and/or other materials provided with the distribution.
                     13:  * 3. Neither the name of the author nor the names of any co-contributors
                     14:  *    may be used to endorse or promote products derived from this software
                     15:  *    without specific prior written permission.
                     16:  *
                     17:  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
                     18:  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
                     19:  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
                     20:  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
                     21:  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
                     22:  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
                     23:  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
                     24:  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
                     25:  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
                     26:  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
                     27:  * SUCH DAMAGE.
                     28:  */
                     29:
                     30: /*
                     31:  * fifofs - FIFO/pipe file system.
                     32:  */
                     33:
                     34: #include <prex/prex.h>
                     35: #include <sys/stat.h>
                     36: #include <sys/vnode.h>
                     37: #include <sys/file.h>
                     38: #include <sys/mount.h>
                     39: #include <sys/syslog.h>
                     40: #include <sys/dirent.h>
                     41: #include <sys/list.h>
                     42:
                     43: #include <ctype.h>
                     44: #include <unistd.h>
                     45: #include <errno.h>
                     46: #include <string.h>
                     47: #include <stdlib.h>
                     48: #include <limits.h>
                     49: #include <fcntl.h>
                     50:
                     51: #include "fifo.h"
                     52:
                     53: struct fifo_node {
                     54:        struct list fn_link;
                     55:        char    *fn_name;       /* name (null-terminated) */
                     56:        cond_t  fn_rcond;       /* cv for read */
                     57:        cond_t  fn_wcond;       /* cv for write */
                     58:        mutex_t fn_rmtx;        /* mutex for read */
                     59:        mutex_t fn_wmtx;        /* mutex for write */
                     60:        int     fn_readers;     /* reader count */
                     61:        int     fn_writers;     /* writer count */
                     62:        int     fn_start;       /* start offset of buffer data */
                     63:        int     fn_size;        /* siez of buffer data */
                     64:        char    *fn_buf;        /* pointer to buffer */
                     65: };
                     66:
                     67: #define fifo_mount     ((vfsop_mount_t)vfs_nullop)
                     68: #define fifo_unmount   ((vfsop_umount_t)vfs_nullop)
                     69: #define fifo_sync      ((vfsop_sync_t)vfs_nullop)
                     70: #define fifo_vget      ((vfsop_vget_t)vfs_nullop)
                     71: #define fifo_statfs    ((vfsop_statfs_t)vfs_nullop)
                     72:
                     73: static int fifo_open   (vnode_t, int);
                     74: static int fifo_close  (vnode_t, file_t);
                     75: static int fifo_read   (vnode_t, file_t, void *, size_t, size_t *);
                     76: static int fifo_write  (vnode_t, file_t, void *, size_t, size_t *);
                     77: #define fifo_seek      ((vnop_seek_t)vop_nullop)
                     78: static int fifo_ioctl  (vnode_t, file_t, u_long, void *);
                     79: #define fifo_fsync     ((vnop_fsync_t)vop_nullop)
                     80: static int fifo_readdir        (vnode_t, file_t, struct dirent *);
                     81: static int fifo_lookup (vnode_t, char *, vnode_t);
                     82: static int fifo_create (vnode_t, char *, mode_t);
                     83: static int fifo_remove (vnode_t, vnode_t, char *);
                     84: #define fifo_rename    ((vnop_rename_t)vop_einval)
                     85: #define fifo_mkdir     ((vnop_mkdir_t)vop_einval)
                     86: #define fifo_rmdir     ((vnop_rmdir_t)vop_einval)
                     87: #define fifo_getattr   ((vnop_getattr_t)vop_nullop)
                     88: #define fifo_setattr   ((vnop_setattr_t)vop_nullop)
                     89: #define fifo_inactive  ((vnop_inactive_t)vop_nullop)
                     90: #define fifo_truncate  ((vnop_truncate_t)vop_nullop)
                     91:
                     92: static void wait_reader(vnode_t);
                     93: static void wakeup_reader(vnode_t);
                     94: static void wait_writer(vnode_t);
                     95: static void wakeup_writer(vnode_t);
                     96:
                     97: #if CONFIG_FS_THREADS > 1
                     98: static mutex_t fifo_lock = MUTEX_INITIALIZER;
                     99: #endif
                    100:
                    101: static struct list fifo_head;
                    102:
                    103: /*
                    104:  * vnode operations
                    105:  */
                    106: struct vnops fifofs_vnops = {
                    107:        fifo_open,              /* open */
                    108:        fifo_close,             /* close */
                    109:        fifo_read,              /* read */
                    110:        fifo_write,             /* write */
                    111:        fifo_seek,              /* seek */
                    112:        fifo_ioctl,             /* ioctl */
                    113:        fifo_fsync,             /* fsync */
                    114:        fifo_readdir,           /* readdir */
                    115:        fifo_lookup,            /* lookup */
                    116:        fifo_create,            /* create */
                    117:        fifo_remove,            /* remove */
                    118:        fifo_rename,            /* remame */
                    119:        fifo_mkdir,             /* mkdir */
                    120:        fifo_rmdir,             /* rmdir */
                    121:        fifo_getattr,           /* getattr */
                    122:        fifo_setattr,           /* setattr */
                    123:        fifo_inactive,          /* inactive */
                    124:        fifo_truncate,          /* truncate */
                    125: };
                    126:
                    127: /*
                    128:  * File system operations
                    129:  */
                    130: struct vfsops fifofs_vfsops = {
                    131:        fifo_mount,             /* mount */
                    132:        fifo_unmount,           /* unmount */
                    133:        fifo_sync,              /* sync */
                    134:        fifo_vget,              /* vget */
                    135:        fifo_statfs,            /* statfs */
                    136:        &fifofs_vnops,          /* vnops */
                    137: };
                    138:
                    139: static int
                    140: fifo_open(vnode_t vp, int flags)
                    141: {
                    142:        struct fifo_node *np = vp->v_data;
                    143:
                    144:        DPRINTF(("fifo_open: path=%s\n", vp->v_path));
                    145:
                    146:        if (!strcmp(vp->v_path, "/"))   /* root ? */
                    147:                return 0;
                    148:
                    149:        /*
                    150:         * Unblock all threads who are waiting in open().
                    151:         */
                    152:        if (flags & FREAD) {
                    153:                if (np->fn_readers == 0 && np->fn_writers > 0)
                    154:                        wakeup_writer(vp);
                    155:                np->fn_readers++;
                    156:        }
                    157:        if (flags & FWRITE) {
                    158:                if (np->fn_writers == 0 && np->fn_readers > 0)
                    159:                        wakeup_reader(vp);
                    160:                np->fn_writers++;
                    161:        }
                    162:
                    163:        /*
                    164:         * If no-one opens FIFO at the other side, wait for open().
                    165:         */
                    166:        if (flags & FREAD) {
                    167:                if (flags & O_NONBLOCK) {
                    168:                } else {
                    169:                        while (np->fn_writers == 0)
                    170:                                wait_writer(vp);
                    171:                }
                    172:        }
                    173:        if (flags & FWRITE) {
                    174:                if (flags & O_NONBLOCK) {
                    175:                        if (np->fn_readers == 0)
                    176:                                return ENXIO;
                    177:                } else {
                    178:                        while (np->fn_readers == 0)
                    179:                                wait_reader(vp);
                    180:                }
                    181:        }
                    182:        return 0;
                    183: }
                    184:
                    185: static int
                    186: fifo_close(vnode_t vp, file_t fp)
                    187: {
                    188:        struct fifo_node *np = vp->v_data;
                    189:
                    190:        DPRINTF(("fifo_close: fp=%x\n", fp));
                    191:
                    192:        if (np == NULL)
                    193:                return 0;
                    194:
                    195:        if (fp->f_flags & FREAD) {
                    196:                np->fn_readers--;
                    197:                if (np->fn_readers == 0)
                    198:                        wakeup_writer(vp);
                    199:        }
                    200:        if (fp->f_flags & FWRITE) {
                    201:                np->fn_writers--;
                    202:                if (np->fn_writers == 0)
                    203:                        wakeup_reader(vp);
                    204:        }
                    205:        if (vp->v_refcnt > 1)
                    206:                return 0;
                    207:
                    208:        return 0;
                    209: }
                    210:
                    211: static int
                    212: fifo_read(vnode_t vp, file_t fp, void *buf, size_t size, size_t *result)
                    213: {
                    214:        struct fifo_node *np = vp->v_data;
                    215:        char *p = buf;
                    216:        int pos, nbytes;
                    217:
                    218:        DPRINTF(("fifo_read\n"));
                    219:
                    220:        /*
                    221:         * If nothing in the pipe, wait.
                    222:         */
                    223:        while (np->fn_size == 0) {
                    224:                /*
                    225:                 * No data and no writer, then EOF
                    226:                 */
                    227:                if (np->fn_writers == 0) {
                    228:                        *result = 0;
                    229:                        return 0;
                    230:                }
                    231:                /*
                    232:                 * wait for data
                    233:                 */
                    234:                wait_writer(vp);
                    235:        }
                    236:        /*
                    237:         * Read
                    238:         */
                    239:        nbytes = (np->fn_size < size) ? np->fn_size : size;
                    240:        np->fn_size -= nbytes;
                    241:        *result = nbytes;
                    242:        pos = np->fn_start;
                    243:        while (nbytes > 0) {
                    244:                *p++ = np->fn_buf[pos];
                    245:                if (++pos > PIPE_BUF)
                    246:                        pos = 0;
                    247:                nbytes--;
                    248:        }
                    249:        np->fn_start = pos;
                    250:
                    251:        wakeup_writer(vp);
                    252:        return 0;
                    253: }
                    254:
                    255: static int
                    256: fifo_write(vnode_t vp, file_t fp, void *buf, size_t size, size_t *result)
                    257: {
                    258:        struct fifo_node *np = vp->v_data;
                    259:        char *p = buf;
                    260:        int pos, nfree, nbytes;
                    261:
                    262:        DPRINTF(("fifo_write\n"));
                    263:
                    264:  again:
                    265:        /*
                    266:         * If the pipe is full,
                    267:         * wait for reads to deplete
                    268:         * and truncate it.
                    269:         */
                    270:        while (np->fn_size >= PIPE_BUF)
                    271:                wait_reader(vp);
                    272:
                    273:        /*
                    274:         * Write
                    275:         */
                    276:        nfree = PIPE_BUF - np->fn_size;
                    277:        nbytes = (nfree < size) ? nfree : size;
                    278:
                    279:        pos = np->fn_start + np->fn_size;
                    280:        if (pos >= PIPE_BUF)
                    281:                pos -= PIPE_BUF;
                    282:        np->fn_size += nbytes;
                    283:        size -= nbytes;
                    284:        while (nbytes > 0) {
                    285:                np->fn_buf[pos] = *p++;
                    286:                if (++pos > PIPE_BUF)
                    287:                        pos = 0;
                    288:                nbytes--;
                    289:        }
                    290:
                    291:        wakeup_reader(vp);
                    292:
                    293:        if (size > 0)
                    294:                goto again;
                    295:
                    296:        *result = size;
                    297:        return 0;
                    298: }
                    299:
                    300: static int
                    301: fifo_ioctl(vnode_t vp, file_t fp, u_long cmd, void *arg)
                    302: {
                    303:        DPRINTF(("fifo_ioctl\n"));
                    304:        return EINVAL;
                    305: }
                    306:
                    307: static int
                    308: fifo_lookup(vnode_t dvp, char *name, vnode_t vp)
                    309: {
                    310:        list_t head, n;
                    311:        struct fifo_node *np = NULL;
                    312:        int found;
                    313:
                    314:        DPRINTF(("fifo_lookup: %s\n", name));
                    315:
                    316:        if (*name == '\0')
                    317:                return ENOENT;
                    318:
                    319:        mutex_lock(&fifo_lock);
                    320:
                    321:        found = 0;
                    322:        head = &fifo_head;
                    323:        for (n = list_first(head); n != head; n = list_next(n)) {
                    324:                np = list_entry(n, struct fifo_node, fn_link);
                    325:                if (strcmp(name, np->fn_name) == 0) {
                    326:                        found = 1;
                    327:                        break;
                    328:                }
                    329:        }
                    330:        if (found == 0) {
                    331:                mutex_unlock(&fifo_lock);
                    332:                return ENOENT;
                    333:        }
                    334:        vp->v_data = np;
                    335:        vp->v_mode = ALLPERMS;
                    336:        vp->v_type = VFIFO;
                    337:        vp->v_size = 0;
                    338:
                    339:        mutex_unlock(&fifo_lock);
                    340:        return 0;
                    341: }
                    342:
                    343: static int
                    344: fifo_create(vnode_t dvp, char *name, mode_t mode)
                    345: {
                    346:        struct fifo_node *np;
                    347:
                    348:        DPRINTF(("create %s in %s\n", name, dvp->v_path));
                    349:
                    350: #if 0
                    351:        if (!S_ISFIFO(mode))
                    352:                return EINVAL;
                    353: #endif
                    354:
                    355:        if ((np = malloc(sizeof(struct fifo_node))) == NULL)
                    356:                return ENOMEM;
                    357:
                    358:        if ((np->fn_buf = malloc(PIPE_BUF)) == NULL) {
                    359:                free(np);
                    360:                return ENOMEM;
                    361:        }
                    362:        np->fn_name = malloc(strlen(name) + 1);
                    363:        if (np->fn_name == NULL) {
                    364:                free(np->fn_buf);
                    365:                free(np);
                    366:                return ENOMEM;
                    367:        }
                    368:
                    369:        strcpy(np->fn_name, name);
                    370:        mutex_init(&np->fn_rmtx);
                    371:        mutex_init(&np->fn_wmtx);
                    372:        cond_init(&np->fn_rcond);
                    373:        cond_init(&np->fn_wcond);
                    374:        np->fn_readers = 0;
                    375:        np->fn_writers = 0;
                    376:        np->fn_start = 0;
                    377:        np->fn_size = 0;
                    378:
                    379:        mutex_lock(&fifo_lock);
                    380:        list_insert(&fifo_head, &np->fn_link);
                    381:        mutex_unlock(&fifo_lock);
                    382:        return 0;
                    383: }
                    384:
                    385: static int
                    386: fifo_remove(vnode_t dvp, vnode_t vp, char *name)
                    387: {
                    388:        struct fifo_node *np = vp->v_data;
                    389:
                    390:        DPRINTF(("remove %s in %s\n", name, dvp->v_path));
                    391:
                    392:        mutex_lock(&fifo_lock);
                    393:        list_remove(&np->fn_link);
                    394:        mutex_unlock(&fifo_lock);
                    395:
                    396:        free(np->fn_name);
                    397:        free(np->fn_buf);
                    398:        free(np);
                    399:
                    400:        vp->v_data = NULL;
                    401:        return 0;
                    402: }
                    403:
                    404: /*
                    405:  * @vp: vnode of the directory.
                    406:  */
                    407: static int
                    408: fifo_readdir(vnode_t vp, file_t fp, struct dirent *dir)
                    409: {
                    410:        struct fifo_node *np;
                    411:        list_t head, n;
                    412:        int i;
                    413:
                    414:        mutex_lock(&fifo_lock);
                    415:
                    416:        if (fp->f_offset == 0) {
                    417:                dir->d_type = DT_DIR;
                    418:                strcpy((char *)&dir->d_name, ".");
                    419:        } else if (fp->f_offset == 1) {
                    420:                dir->d_type = DT_DIR;
                    421:                strcpy((char *)&dir->d_name, "..");
                    422:        } else {
                    423:                i = 0;
                    424:                np = NULL;
                    425:                head = &fifo_head;
                    426:                for (n = list_first(head); n != head; n = list_next(n)) {
                    427:                        if (i == (fp->f_offset - 2)) {
                    428:                                np = list_entry(n, struct fifo_node, fn_link);
                    429:                                break;
                    430:                        }
                    431:                }
                    432:                if (np == NULL) {
                    433:                        mutex_unlock(&fifo_lock);
                    434:                        return ENOENT;
                    435:                }
                    436:                dir->d_type = DT_FIFO;
                    437:                strcpy((char *)&dir->d_name, np->fn_name);
                    438:        }
                    439:        dir->d_fileno = fp->f_offset;
                    440:        dir->d_namlen = strlen(dir->d_name);
                    441:
                    442:        fp->f_offset++;
                    443:
                    444:        mutex_unlock(&fifo_lock);
                    445:        return 0;
                    446: }
                    447:
                    448: int
                    449: fifofs_init(void)
                    450: {
                    451:        list_init(&fifo_head);
                    452:        return 0;
                    453: }
                    454:
                    455:
                    456: static void
                    457: wait_reader(vnode_t vp)
                    458: {
                    459:        struct fifo_node *np = vp->v_data;
                    460:
                    461:        DPRINTF(("wait_reader: %x\n", np));
                    462:        vn_unlock(vp);
                    463:        mutex_lock(&np->fn_rmtx);
                    464:        cond_wait(&np->fn_rcond, &np->fn_rmtx);
                    465:        mutex_unlock(&np->fn_rmtx);
                    466:        vn_lock(vp);
                    467: }
                    468:
                    469: static void
                    470: wakeup_writer(vnode_t vp)
                    471: {
                    472:        struct fifo_node *np = vp->v_data;
                    473:
                    474:        DPRINTF(("wakeup_writer: %x\n", np));
                    475:        cond_broadcast(&np->fn_rcond);
                    476: }
                    477:
                    478: static void
                    479: wait_writer(vnode_t vp)
                    480: {
                    481:        struct fifo_node *np = vp->v_data;
                    482:
                    483:        DPRINTF(("wait_writer: %x\n", np));
                    484:        vn_unlock(vp);
                    485:        mutex_lock(&np->fn_wmtx);
                    486:        cond_wait(&np->fn_wcond, &np->fn_wmtx);
                    487:        mutex_unlock(&np->fn_wmtx);
                    488:        vn_lock(vp);
                    489: }
                    490:
                    491: static void
                    492: wakeup_reader(vnode_t vp)
                    493: {
                    494:        struct fifo_node *np = vp->v_data;
                    495:
                    496:        DPRINTF(("wakeup_reader: %x\n", np));
                    497:        cond_broadcast(&np->fn_wcond);
                    498: }

CVSweb