2 * Copyright (c) 2013-2014 Robert N. M. Watson
5 * This software was developed by SRI International and the University of
6 * Cambridge Computer Laboratory under DARPA/AFRL contract (FA8750-10-C-0237)
7 * ("CTSRD"), as part of the DARPA CRASH research programme.
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
12 * 1. Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
19 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31 #include <sys/cdefs.h>
32 __FBSDID("$FreeBSD$");
34 #include <sys/param.h>
36 #include <bootstrap.h>
44 static int beri_cfi_disk_init(void);
45 static int beri_cfi_disk_open(struct open_file *, ...);
46 static int beri_cfi_disk_close(struct open_file *);
47 static int beri_cfi_disk_strategy(void *, int, daddr_t, size_t,
49 static int beri_cfi_disk_print(int);
51 struct devsw beri_cfi_disk = {
54 .dv_init = beri_cfi_disk_init,
55 .dv_strategy = beri_cfi_disk_strategy,
56 .dv_open = beri_cfi_disk_open,
57 .dv_close = beri_cfi_disk_close,
59 .dv_print = beri_cfi_disk_print,
64 beri_cfi_disk_init(void)
71 beri_cfi_disk_strategy(void *devdata, int flag, daddr_t dblk, size_t size,
72 char *buf, size_t *rsizep)
83 error = cfi_read(buf, dblk, size >> 9);
84 if (error == 0 && rsizep != NULL)
87 printf("%s: error %d\n", __func__, error);
92 beri_cfi_disk_open(struct open_file *f, ...)
95 struct disk_devdesc *dev;
98 dev = va_arg(ap, struct disk_devdesc *);
101 if (dev->d_unit != 0)
103 return (disk_open(dev, cfi_get_mediasize(), cfi_get_sectorsize()));
107 beri_cfi_disk_close(struct open_file *f)
109 struct disk_devdesc *dev;
111 dev = (struct disk_devdesc *)f->f_devdata;
112 return (disk_close(dev));
116 beri_cfi_disk_print(int verbose)
118 struct disk_devdesc dev;
122 printf("%s devices:", beri_cfi_disk.dv_name);
123 if ((ret = pager_output("\n")) != 0)
126 snprintf(line, sizeof(line), " cfi%d CFI flash device\n", 0);
127 ret = pager_output(line);
130 dev.d_dev = &beri_cfi_disk;
133 dev.d_partition = -1;
134 if (disk_open(&dev, cfi_get_mediasize(), cfi_get_sectorsize()) == 0) {
135 snprintf(line, sizeof(line), " cfi%d", 0);
136 ret = disk_print(&dev, line, verbose);