Home | History | Annotate | Line # | Download | only in lib 
      1 /*	$NetBSD: riscosdisk.c,v 1.4 2011/07/17 20:54:35 joerg Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2001, 2006 Ben Harris
      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  * 3. The name of the author may not be used to endorse or promote products
     16  *    derived from this software without specific prior written permission.
     17  *
     18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     19  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     20  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     21  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     22  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     23  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     24  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     25  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     26  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     27  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     28  */
     29 
     30 #include <sys/types.h>
     31 #include <sys/param.h>
     32 #include <sys/disklabel.h>
     33 #include <lib/libsa/stand.h>
     34 #include <riscoscalls.h>
     35 #include <riscosdisk.h>
     36 #include <riscospart.h>
     37 
     38 struct riscosdisk {
     39 	void	*privword;
     40 	int	drive;
     41 	daddr_t	boff;
     42 };
     43 
     44 static void *
     45 rodisk_getprivateword(char const *fsname)
     46 {
     47 	void *privword;
     48 	char module[20];
     49 	os_error *err;
     50 
     51 	/* XXX The %c dance is because libsa printf can't do %% */
     52 	snprintf(module, sizeof(module), "FileCore%c%s", '%', fsname);
     53 	err = xosmodule_lookup(module, NULL, NULL, NULL, &privword, NULL);
     54 	if (err != NULL)
     55 		return NULL;
     56 	return privword;
     57 }
     58 
     59 int
     60 rodisk_open(struct open_file *f, ... /* char const *fsname, int drive,
     61     int partition */)
     62 {
     63 	va_list ap;
     64 	struct disklabel dl;
     65 	char const *fsname;
     66 	int drive, partition, nfd, nhd, err;
     67 	struct riscosdisk *rd;
     68 	void *privword;
     69 
     70 	va_start(ap, f);
     71 	fsname = va_arg(ap, char const *);
     72 	drive = va_arg(ap, int);
     73 	partition = va_arg(ap, int);
     74 	va_end(ap);
     75 
     76 	if ((privword = rodisk_getprivateword(fsname)) == NULL)
     77 		return ECTLR;
     78 	if (xfilecore_drives(&privword, NULL, &nfd, &nhd) != NULL)
     79 		return ECTLR;
     80 	if (drive < 0 ||
     81 	    (drive < 4 && drive >= nfd) ||
     82 	    drive >= nhd + 4)
     83 		return EUNIT;
     84 
     85 	rd = alloc(sizeof(*rd));
     86 	rd->privword = privword;
     87 	rd->drive = drive;
     88 	rd->boff = 0;
     89 	f->f_devdata = rd;
     90 	if (partition != RAW_PART) {
     91 		err = getdisklabel_acorn(f, &dl);
     92 		if (err != 0) {
     93 			dealloc(rd, sizeof(*rd));
     94 			return err;
     95 		}
     96 		if (partition >= dl.d_npartitions ||
     97 		    dl.d_partitions[partition].p_size == 0) {
     98 			dealloc(rd, sizeof(*rd));
     99 			return EPART;
    100 		}
    101 		rd->boff = dl.d_partitions[partition].p_offset;
    102 	}
    103 	return 0;
    104 }
    105 
    106 int
    107 rodisk_close(struct open_file *f)
    108 {
    109 	struct riscosdisk *rd = f->f_devdata;
    110 
    111 	dealloc(rd, sizeof *rd);
    112 	return 0;
    113 }
    114 
    115 int
    116 rodisk_strategy(void *devdata, int flag, daddr_t dblk, size_t size,
    117     void *buf, size_t *rsize)
    118 {
    119 	struct riscosdisk *rd = devdata;
    120 	size_t resid;
    121 	uint32_t daddr, ndaddr;
    122 	void *nbuf;
    123 	os_error *err;
    124 
    125 	if (flag != F_READ)
    126 		return EROFS;
    127 
    128 	dblk += rd->boff;
    129 
    130 	if (rsize) *rsize = 0;
    131 	if (dblk < 1 << (29 - DEV_BSHIFT)) {
    132 		daddr = (dblk * DEV_BSIZE) | (rd->drive << 29);
    133 		if ((err = xfilecorediscop_read_sectors(0, daddr, buf, size,
    134 		    &rd->privword, &ndaddr, &nbuf, &resid)) != NULL)
    135 			goto eio;
    136 	} else if (dblk < 1 << 29) {
    137 		daddr = dblk | (rd->drive << 29);
    138 		if ((err = xfilecoresectorop_read_sectors(0, daddr, buf, size,
    139 		    &rd->privword, &ndaddr, &nbuf, &resid)) != NULL)
    140 			goto eio;
    141 	} else if (dblk < 1LL << (64 - DEV_BSHIFT)){
    142 		struct filecore_daddr64 daddr64;
    143 		daddr64.drive = rd->drive;
    144 		daddr64.daddr = dblk * DEV_BSIZE;
    145 		if ((err = xfilecorediscop64_read_sectors(0, &daddr64, buf,
    146 		    size, NULL, &rd->privword, &ndaddr, &nbuf, &resid)) !=
    147 		    NULL)
    148 			goto eio;
    149 	} else
    150 		return EIO;
    151 	if (rsize)
    152 		*rsize = size - resid;
    153 	return 0;
    154 eio:
    155 	printf("Error: %s\n", err->errmess);
    156 	return EIO;
    157 }
    158