nand_writeoob.c revision 235537
1/*- 2 * Copyright (c) 2010-2012 Semihalf. 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 AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 */ 26 27#include <sys/cdefs.h> 28__FBSDID("$FreeBSD: head/usr.sbin/nandtool/nand_writeoob.c 235537 2012-05-17 10:11:18Z gber $"); 29 30#include <stdio.h> 31#include <stdlib.h> 32#include <unistd.h> 33#include <fcntl.h> 34#include <libgeom.h> 35#include <sys/disk.h> 36#include <dev/nand/nand_dev.h> 37#include "nandtool.h" 38 39int nand_write_oob(struct cmd_param *params) 40{ 41 struct chip_param_io chip_params; 42 struct nand_oob_rw req; 43 char *dev, *in; 44 int fd = -1, fd_in = -1, ret = 0; 45 uint8_t *buf = NULL; 46 int page; 47 48 if (!(dev = param_get_string(params, "dev"))) { 49 fprintf(stderr, "Please supply valid 'dev' parameter.\n"); 50 return (1); 51 } 52 53 if (!(in = param_get_string(params, "in"))) { 54 fprintf(stderr, "Please supply valid 'in' parameter.\n"); 55 return (1); 56 } 57 58 if ((page = param_get_int(params, "page")) < 0) { 59 fprintf(stderr, "Please supply valid 'page' parameter.\n"); 60 return (1); 61 } 62 63 if ((fd = g_open(dev, 1)) == -1) { 64 perrorf("Cannot open %s", dev); 65 return (1); 66 } 67 68 if ((fd_in = open(in, O_RDONLY)) == -1) { 69 perrorf("Cannot open %s", in); 70 ret = 1; 71 goto out; 72 } 73 74 if (ioctl(fd, NAND_IO_GET_CHIP_PARAM, &chip_params) == -1) { 75 perrorf("Cannot ioctl(NAND_IO_GET_CHIP_PARAM)"); 76 ret = 1; 77 goto out; 78 } 79 80 buf = malloc(chip_params.oob_size); 81 if (buf == NULL) { 82 perrorf("Cannot allocate %d bytes\n", chip_params.oob_size); 83 ret = 1; 84 goto out; 85 } 86 87 if (read(fd_in, buf, chip_params.oob_size) == -1) { 88 perrorf("Cannot read from %s", in); 89 ret = 1; 90 goto out; 91 } 92 93 req.page = page; 94 req.len = chip_params.oob_size; 95 req.data = buf; 96 97 if (ioctl(fd, NAND_IO_OOB_PROG, &req) == -1) { 98 perrorf("Cannot write OOB to %s", dev); 99 ret = 1; 100 goto out; 101 } 102 103out: 104 g_close(fd); 105 if (fd_in != -1) 106 close(fd_in); 107 if (buf) 108 free(buf); 109 110 return (ret); 111} 112 113 114