stand/powerpc/ps3/ps3cdrom.c

   1 /*-
   2  * Copyright (C) 2011 glevand <geoffrey.levand@mail.ru>
   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  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  15  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  16  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  17  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  18  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  19  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
  20  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  21  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
  22  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
  23  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  24  *
  25  * $FreeBSD$
  26  */
  27
  28 #include <sys/param.h>
  29 #include <sys/endian.h>
  30 #include <machine/stdarg.h>
  31 #include <stand.h>
  32
  33 #include "bootstrap.h"
  34 #include "ps3bus.h"
  35 #include "ps3devdesc.h"
  36 #include "ps3stor.h"
  37
  38 #define dev_printf(dev, fmt, args...)   \
  39         printf("%s%d: " fmt "\n", dev->d_dev->dv_name, dev->d_unit, ##args)
  40
  41 #ifdef CD_DEBUG
  42 #define DEBUG(fmt, args...)             printf("%s:%d: " fmt "\n", __func__, __LINE__, ##args)
  43 #else
  44 #define DEBUG(fmt, args...)
  45 #endif
  46
  47 static int ps3cdrom_init(void);
  48 static int ps3cdrom_strategy(void *devdata, int flag, daddr_t dblk,
  49         size_t size, char *buf, size_t *rsize);
  50 static int ps3cdrom_open(struct open_file *f, ...);
  51 static int ps3cdrom_close(struct open_file *f);
  52 static int ps3cdrom_print(int verbose);
  53
  54 struct devsw ps3cdrom = {
  55         "cd",
  56         DEVT_CD,
  57         ps3cdrom_init,
  58         ps3cdrom_strategy,
  59         ps3cdrom_open,
  60         ps3cdrom_close,
  61         noioctl,
  62         ps3cdrom_print,
  63 };
  64
  65 static struct ps3_stordev stor_dev;
  66
  67 static int ps3cdrom_init(void)
  68 {
  69         int err;
  70
  71         err = ps3stor_setup(&stor_dev, PS3_DEV_TYPE_STOR_CDROM);
  72         if (err)
  73                 return err;
  74
  75         return 0;
  76 }
  77
  78 static int ps3cdrom_strategy(void *devdata, int flag, daddr_t dblk,
  79         size_t size, char *buf, size_t *rsize)
  80 {
  81         struct ps3_devdesc *dev = (struct ps3_devdesc *) devdata;
  82         int err;
  83
  84         DEBUG("d_unit=%u dblk=%llu size=%u", dev->d_unit, dblk, size);
  85
  86         flag &= F_MASK;
  87         if (flag != F_READ) {
  88                 dev_printf(dev, "write operation is not supported!");
  89                 return EROFS;
  90         }
  91
  92         if (dblk % (stor_dev.sd_blksize / DEV_BSIZE) != 0)
  93                 return EINVAL;
  94
  95         dblk /= (stor_dev.sd_blksize / DEV_BSIZE);
  96
  97         if (size % stor_dev.sd_blksize) {
  98                 dev_printf(dev,
  99                     "size=%u is not multiple of device block size=%llu", size,
 100                     stor_dev.sd_blksize);
 101                 return EINVAL;
 102         }
 103
 104         if (rsize)
 105                 *rsize = 0;
 106
 107         err = ps3stor_read_sectors(&stor_dev, dev->d_unit, dblk,
 108                 size / stor_dev.sd_blksize, 0, buf);
 109
 110         if (!err && rsize)
 111                 *rsize = size;
 112
 113         if (err)
 114                 dev_printf(dev,
 115                     "read operation failed dblk=%llu size=%d err=%d", dblk,
 116                     size, err);
 117
 118         return err;
 119 }
 120
 121 static int ps3cdrom_open(struct open_file *f, ...)
 122 {
 123         char buf[2048];
 124         va_list ap;
 125         struct ps3_devdesc *dev;
 126         int err;
 127
 128         va_start(ap, f);
 129         dev = va_arg(ap, struct ps3_devdesc *);
 130         va_end(ap);
 131
 132         if (dev->d_unit > 0) {
 133                 dev_printf(dev, "attempt to open nonexistent disk");
 134                 return ENXIO;
 135         }
 136
 137         err = ps3stor_read_sectors(&stor_dev, dev->d_unit, 16, 1, 0, buf);
 138         if (err)
 139                 return EIO;
 140
 141         /* Do not attach if not ISO9660 (workaround for buggy firmware) */
 142         if (memcmp(buf, "\001CD001", 6) != 0)
 143                 return EIO;
 144
 145         return 0;
 146 }
 147
 148 static int ps3cdrom_close(struct open_file *f)
 149 {
 150         return 0;
 151 }
 152
 153 static int ps3cdrom_print(int verbose)
 154 {
 155         return (0);
 156 }