Differential D4761 Diff 14398 usr.bin/sdiotool/sdiotool.c

Changeset View

Standalone View

usr.bin/sdiotool/sdiotool.c

This file was added.

				/*
				* Copyright (c) 2016 Ilya Bakulin
				* All rights reserved.
				*
				* Redistribution and use in source and binary forms, with or without
				* modification, are permitted provided that the following conditions
				* are met:
				* 1. Redistributions of source code must retain the above copyright
				* notice, this list of conditions and the following disclaimer.
				* 2. Redistributions in binary form must reproduce the above copyright
				* notice, this list of conditions and the following disclaimer in the
				* documentation and/or other materials provided with the distribution.
				* 3. The name of the author may not be used to endorse or promote products
				* derived from this software without specific prior written permission.
				*
				* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
				* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
				* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
				* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
				* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
				* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
				* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
				* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
				* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
				* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
				* SUCH DAMAGE.
				*/

				#include <sys/cdefs.h>
				__FBSDID("$FreeBSD$");

				#include <sys/ioctl.h>
				#include <sys/stdint.h>
				#include <sys/types.h>
				#include <sys/stat.h>
				#include <sys/endian.h>
				#include <sys/sbuf.h>

				#include <stdio.h>
				#include <stdlib.h>
				#include <string.h>
				#include <unistd.h>
				#include <inttypes.h>
				#include <limits.h>
				#include <fcntl.h>
				#include <ctype.h>
				#include <err.h>
				#include <libutil.h>

				#include <cam/cam.h>
				#include <cam/cam_debug.h>
				#include <cam/cam_ccb.h>
				#include <cam/mmc/mmc_all.h>
				#include <camlib.h>

				static int sdio_rw_direct(struct cam_device *dev,
				uint8_t func_number,
				uint32_t addr,
				uint8_t is_write,
				uint8_t *data);

				/* Use CMD52 to read or write a single byte */
				int
				sdio_rw_direct(struct cam_device *dev,
				uint8_t func_number,
				uint32_t addr,
				uint8_t is_write,
				uint8_t *data) {
				union ccb *ccb;
				uint32_t flags;
				uint32_t arg;

				ccb = cam_getccb(dev);
				if (ccb == NULL) {
				warnx("%s: error allocating CCB", __func__);
				return (1);
				}
				bzero(&(&ccb->ccb_h)[1],
				sizeof(union ccb) - sizeof(struct ccb_hdr));

				flags = MMC_RSP_R5 \| MMC_CMD_AC;
				arg = SD_IO_RW_FUNC(func_number) \| SD_IO_RW_ADR(addr);
				if (is_write)
				arg \|= SD_IO_RW_WR \| SD_IO_RW_RAW \| SD_IO_RW_DAT(*data);

				cam_fill_mmcio(&ccb->mmcio,
				/retries/ 0,
				/cbfcnp/ NULL,
				/flags/ flags,
				/mmc_opcode/ SD_IO_RW_DIRECT,
				/mmc_arg/ arg,
				/mmc_flags/ flags,
				/mmc_data/ 0,
				/timeout/ 5000);

				if (((retval = cam_send_ccb(device, ccb)) < 0)
				\|\| ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP)) {
				const char warnstr[] = "error sending command";

				if (retval < 0)
				warn(warnstr);
				else
				warnx(warnstr);
				}

				cam_freeccb(ccb);
				return 0;
				}

				int
				main(__unused int argc, __unused char **argv) {
				char device[] = "pass";
				int unit = 0;
				struct cam_device *cam_dev = NULL;
				if ((cam_dev = cam_open_spec_device(device, unit, O_RDWR, NULL)) == NULL)
				errx(1, "Cannot open device");

				cam_close_spec_device(cam_dev);
				}