Changeset View
Changeset View
Standalone View
Standalone View
head/sys/dev/sdio/sdio_subr.c
Property | Old Value | New Value |
---|---|---|
svn:eol-style | null | native \ No newline at end of property |
svn:keywords | null | FreeBSD=%H \ No newline at end of property |
svn:mime-type | null | text/plain \ No newline at end of property |
/*- | |||||
* Copyright (c) 2017 Ilya Bakulin. All rights reserved. | |||||
* Copyright (c) 2018-2019 The FreeBSD Foundation | |||||
* | |||||
* Portions of this software were developed by Björn Zeeb | |||||
* under sponsorship from the FreeBSD Foundation. | |||||
* | |||||
* 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. | |||||
* | |||||
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 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. | |||||
* | |||||
* | |||||
* Portions of this software may have been developed with reference to | |||||
* the SD Simplified Specification. The following disclaimer may apply: | |||||
* | |||||
* The following conditions apply to the release of the simplified | |||||
* specification ("Simplified Specification") by the SD Card Association and | |||||
* the SD Group. The Simplified Specification is a subset of the complete SD | |||||
* Specification which is owned by the SD Card Association and the SD | |||||
* Group. This Simplified Specification is provided on a non-confidential | |||||
* basis subject to the disclaimers below. Any implementation of the | |||||
* Simplified Specification may require a license from the SD Card | |||||
* Association, SD Group, SD-3C LLC or other third parties. | |||||
* | |||||
* Disclaimers: | |||||
* | |||||
* The information contained in the Simplified Specification is presented only | |||||
* as a standard specification for SD Cards and SD Host/Ancillary products and | |||||
* is provided "AS-IS" without any representations or warranties of any | |||||
* kind. No responsibility is assumed by the SD Group, SD-3C LLC or the SD | |||||
* Card Association for any damages, any infringements of patents or other | |||||
* right of the SD Group, SD-3C LLC, the SD Card Association or any third | |||||
* parties, which may result from its use. No license is granted by | |||||
* implication, estoppel or otherwise under any patent or other rights of the | |||||
* SD Group, SD-3C LLC, the SD Card Association or any third party. Nothing | |||||
* herein shall be construed as an obligation by the SD Group, the SD-3C LLC | |||||
* or the SD Card Association to disclose or distribute any technical | |||||
* information, know-how or other confidential information to any third party. | |||||
*/ | |||||
#include <sys/cdefs.h> | |||||
__FBSDID("$FreeBSD$"); | |||||
#include <sys/types.h> | |||||
#include <sys/param.h> | |||||
#include <sys/kernel.h> | |||||
#include <sys/systm.h> | |||||
#include <sys/bus.h> | |||||
#include <sys/endian.h> | |||||
#include <dev/mmc/mmcreg.h> | |||||
#include <dev/sdio/sdiob.h> | |||||
#include <dev/sdio/sdio_subr.h> | |||||
#include "sdio_if.h" | |||||
/* Works on F0. */ | |||||
static int | |||||
sdio_set_bool_for_func(device_t dev, uint32_t addr, uint8_t fn, bool enable) | |||||
{ | |||||
device_t pdev; | |||||
int error; | |||||
uint8_t val; | |||||
bool enabled; | |||||
pdev = device_get_parent(dev); | |||||
error = SDIO_READ_DIRECT(pdev, 0, addr, &val); | |||||
if (error != 0) | |||||
return (error); | |||||
enabled = (val & (1 << fn)) ? true : false; | |||||
if (enabled == enable) | |||||
return (0); | |||||
if (enable) | |||||
val |= (1 << fn); | |||||
else | |||||
val &= ~(1 << fn); | |||||
error = SDIO_WRITE_DIRECT(pdev, 0, addr, val); | |||||
return (error); | |||||
} | |||||
int | |||||
sdio_enable_func(struct sdio_func *f) | |||||
{ | |||||
return (sdio_set_bool_for_func(f->dev, SD_IO_CCCR_FN_ENABLE, | |||||
f->fn, true)); | |||||
} | |||||
int | |||||
sdio_disable_func(struct sdio_func *f) | |||||
{ | |||||
return (sdio_set_bool_for_func(f->dev, SD_IO_CCCR_FN_ENABLE, | |||||
f->fn, false)); | |||||
} | |||||
int | |||||
sdio_set_block_size(struct sdio_func *f, uint16_t bs) | |||||
{ | |||||
device_t pdev; | |||||
int error; | |||||
uint32_t addr; | |||||
uint16_t v; | |||||
if (!sdio_get_support_multiblk(f->dev)) | |||||
return (EOPNOTSUPP); | |||||
pdev = device_get_parent(f->dev); | |||||
addr = SD_IO_FBR_START * f->fn + SD_IO_FBR_IOBLKSZ; | |||||
v = htole16(bs); | |||||
/* Always write through F0. */ | |||||
error = SDIO_WRITE_DIRECT(pdev, 0, addr, v & 0xff); | |||||
if (error == 0) | |||||
error = SDIO_WRITE_DIRECT(pdev, 0, addr + 1, | |||||
(v >> 8) & 0xff); | |||||
if (error == 0) | |||||
f->cur_blksize = bs; | |||||
return (error); | |||||
} | |||||
uint8_t | |||||
sdio_readb(struct sdio_func *f, uint32_t addr, int *err) | |||||
{ | |||||
int error; | |||||
uint8_t v; | |||||
error = SDIO_READ_DIRECT(device_get_parent(f->dev), f->fn, addr, &v); | |||||
if (error) { | |||||
if (err != NULL) | |||||
*err = error; | |||||
return (0xff); | |||||
} else { | |||||
if (err != NULL) | |||||
*err = 0; | |||||
return (v); | |||||
} | |||||
} | |||||
void | |||||
sdio_writeb(struct sdio_func *f, uint8_t val, uint32_t addr, int *err) | |||||
{ | |||||
int error; | |||||
error = SDIO_WRITE_DIRECT(device_get_parent(f->dev), f->fn, addr, val); | |||||
if (err != NULL) | |||||
*err = error; | |||||
} | |||||
uint32_t | |||||
sdio_readl(struct sdio_func *f, uint32_t addr, int *err) | |||||
{ | |||||
int error; | |||||
uint32_t v; | |||||
error = SDIO_READ_EXTENDED(device_get_parent(f->dev), f->fn, addr, | |||||
sizeof(v), (uint8_t *)&v, false); | |||||
if (error) { | |||||
if (err != NULL) | |||||
*err = error; | |||||
return (0xffffffff); | |||||
} else { | |||||
if (err != NULL) | |||||
*err = 0; | |||||
return (le32toh(v)); | |||||
} | |||||
} | |||||
void | |||||
sdio_writel(struct sdio_func *f, uint32_t val, uint32_t addr, int *err) | |||||
{ | |||||
int error; | |||||
error = SDIO_WRITE_EXTENDED(device_get_parent(f->dev), f->fn, addr, | |||||
sizeof(val), (uint8_t *)&val, false); | |||||
if (err != NULL) | |||||
*err = error; | |||||
} | |||||
uint8_t | |||||
sdio_f0_readb(struct sdio_func *f, uint32_t addr, int *err) | |||||
{ | |||||
int error; | |||||
uint8_t v; | |||||
error = SDIO_READ_DIRECT(device_get_parent(f->dev), 0, addr, &v); | |||||
if (error) { | |||||
if (err != NULL) | |||||
*err = error; | |||||
return (0xff); | |||||
} else { | |||||
if (err != NULL) | |||||
*err = 0; | |||||
return (v); | |||||
} | |||||
} | |||||
void | |||||
sdio_f0_writeb(struct sdio_func *f, uint8_t val, uint32_t addr, int *err) | |||||
{ | |||||
int error; | |||||
error = SDIO_WRITE_DIRECT(device_get_parent(f->dev), 0, addr, val); | |||||
if (err != NULL) | |||||
*err = error; | |||||
} | |||||
/* end */ |