^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) * Sonics Silicon Backplane
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * SDIO-Hostbus related functions
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright 2009 Albert Herranz <albert_herranz@yahoo.es>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * Based on drivers/ssb/pcmcia.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * Copyright 2006 Johannes Berg <johannes@sipsolutions.net>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * Copyright 2007-2008 Michael Buesch <m@bues.ch>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) * Licensed under the GNU/GPL. See COPYING for details.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include "ssb_private.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/ssb/ssb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/etherdevice.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/mmc/sdio_func.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) /* Define the following to 1 to enable a printk on each coreswitch. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #define SSB_VERBOSE_SDIOCORESWITCH_DEBUG 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) /* Hardware invariants CIS tuples */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #define SSB_SDIO_CIS 0x80
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define SSB_SDIO_CIS_SROMREV 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define SSB_SDIO_CIS_ID 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define SSB_SDIO_CIS_BOARDREV 0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define SSB_SDIO_CIS_PA 0x03
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define SSB_SDIO_CIS_PA_PA0B0_LO 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define SSB_SDIO_CIS_PA_PA0B0_HI 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define SSB_SDIO_CIS_PA_PA0B1_LO 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define SSB_SDIO_CIS_PA_PA0B1_HI 3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define SSB_SDIO_CIS_PA_PA0B2_LO 4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define SSB_SDIO_CIS_PA_PA0B2_HI 5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define SSB_SDIO_CIS_PA_ITSSI 6
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define SSB_SDIO_CIS_PA_MAXPOW 7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define SSB_SDIO_CIS_OEMNAME 0x04
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define SSB_SDIO_CIS_CCODE 0x05
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define SSB_SDIO_CIS_ANTENNA 0x06
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define SSB_SDIO_CIS_ANTGAIN 0x07
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #define SSB_SDIO_CIS_BFLAGS 0x08
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) #define SSB_SDIO_CIS_LEDS 0x09
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) #define CISTPL_FUNCE_LAN_NODE_ID 0x04 /* same as in PCMCIA */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) * Function 1 miscellaneous registers.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) * Definitions match src/include/sbsdio.h from the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) * Android Open Source Project
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) * http://android.git.kernel.org/?p=platform/system/wlan/broadcom.git
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) #define SBSDIO_FUNC1_SBADDRLOW 0x1000a /* SB Address window Low (b15) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) #define SBSDIO_FUNC1_SBADDRMID 0x1000b /* SB Address window Mid (b23-b16) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) #define SBSDIO_FUNC1_SBADDRHIGH 0x1000c /* SB Address window High (b24-b31) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) /* valid bits in SBSDIO_FUNC1_SBADDRxxx regs */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) #define SBSDIO_SBADDRLOW_MASK 0x80 /* Valid address bits in SBADDRLOW */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) #define SBSDIO_SBADDRMID_MASK 0xff /* Valid address bits in SBADDRMID */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) #define SBSDIO_SBADDRHIGH_MASK 0xff /* Valid address bits in SBADDRHIGH */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) #define SBSDIO_SB_OFT_ADDR_MASK 0x7FFF /* sb offset addr is <= 15 bits, 32k */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) /* REVISIT: this flag doesn't seem to matter */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) #define SBSDIO_SB_ACCESS_2_4B_FLAG 0x8000 /* forces 32-bit SB access */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) * Address map within the SDIO function address space (128K).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) * Start End Description
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) * ------- ------- ------------------------------------------
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) * 0x00000 0x0ffff selected backplane address window (64K)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) * 0x10000 0x1ffff backplane control registers (max 64K)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) * The current address window is configured by writing to registers
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) * SBADDRLOW, SBADDRMID and SBADDRHIGH.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) * In order to access the contents of a 32-bit Silicon Backplane address
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) * the backplane address window must be first loaded with the highest
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) * 16 bits of the target address. Then, an access must be done to the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) * SDIO function address space using the lower 15 bits of the address.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) * Bit 15 of the address must be set when doing 32 bit accesses.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) * 10987654321098765432109876543210
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) * WWWWWWWWWWWWWWWWW SB Address Window
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) * OOOOOOOOOOOOOOOO Offset within SB Address Window
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) * a 32-bit access flag
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) * SSB I/O via SDIO.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) * NOTE: SDIO address @addr is 17 bits long (SDIO address space is 128K).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) static inline struct device *ssb_sdio_dev(struct ssb_bus *bus)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) return &bus->host_sdio->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) /* host claimed */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) static int ssb_sdio_writeb(struct ssb_bus *bus, unsigned int addr, u8 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) sdio_writeb(bus->host_sdio, val, addr, &error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) if (unlikely(error)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) dev_dbg(ssb_sdio_dev(bus), "%08X <- %02x, error %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) addr, val, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) #if 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) static u8 ssb_sdio_readb(struct ssb_bus *bus, unsigned int addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) u8 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) val = sdio_readb(bus->host_sdio, addr, &error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) if (unlikely(error)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) dev_dbg(ssb_sdio_dev(bus), "%08X -> %02x, error %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) addr, val, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) /* host claimed */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) static int ssb_sdio_set_sbaddr_window(struct ssb_bus *bus, u32 address)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) error = ssb_sdio_writeb(bus, SBSDIO_FUNC1_SBADDRLOW,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) (address >> 8) & SBSDIO_SBADDRLOW_MASK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) error = ssb_sdio_writeb(bus, SBSDIO_FUNC1_SBADDRMID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) (address >> 16) & SBSDIO_SBADDRMID_MASK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) error = ssb_sdio_writeb(bus, SBSDIO_FUNC1_SBADDRHIGH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) (address >> 24) & SBSDIO_SBADDRHIGH_MASK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) bus->sdio_sbaddr = address;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) dev_dbg(ssb_sdio_dev(bus), "failed to set address window"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) " to 0x%08x, error %d\n", address, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) /* for enumeration use only */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) u32 ssb_sdio_scan_read32(struct ssb_bus *bus, u16 offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) sdio_claim_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) val = sdio_readl(bus->host_sdio, offset, &error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) sdio_release_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) if (unlikely(error)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) dev_dbg(ssb_sdio_dev(bus), "%04X:%04X > %08x, error %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) bus->sdio_sbaddr >> 16, offset, val, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) /* for enumeration use only */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) int ssb_sdio_scan_switch_coreidx(struct ssb_bus *bus, u8 coreidx)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) u32 sbaddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) sbaddr = (coreidx * SSB_CORE_SIZE) + SSB_ENUM_BASE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) sdio_claim_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) error = ssb_sdio_set_sbaddr_window(bus, sbaddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) sdio_release_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) dev_err(ssb_sdio_dev(bus), "failed to switch to core %u,"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) " error %d\n", coreidx, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) /* host must be already claimed */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) static int ssb_sdio_switch_core(struct ssb_bus *bus, struct ssb_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) u8 coreidx = dev->core_index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) u32 sbaddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) sbaddr = (coreidx * SSB_CORE_SIZE) + SSB_ENUM_BASE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) if (unlikely(bus->sdio_sbaddr != sbaddr)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) #if SSB_VERBOSE_SDIOCORESWITCH_DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) dev_info(ssb_sdio_dev(bus),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) "switching to %s core, index %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) ssb_core_name(dev->id.coreid), coreidx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) error = ssb_sdio_set_sbaddr_window(bus, sbaddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) dev_dbg(ssb_sdio_dev(bus), "failed to switch to"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) " core %u, error %d\n", coreidx, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) bus->mapped_device = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) static u8 ssb_sdio_read8(struct ssb_device *dev, u16 offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) struct ssb_bus *bus = dev->bus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) u8 val = 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) sdio_claim_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) if (unlikely(ssb_sdio_switch_core(bus, dev)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) offset |= bus->sdio_sbaddr & 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) offset &= SBSDIO_SB_OFT_ADDR_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) val = sdio_readb(bus->host_sdio, offset, &error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) dev_dbg(ssb_sdio_dev(bus), "%04X:%04X > %02x, error %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) bus->sdio_sbaddr >> 16, offset, val, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) sdio_release_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) static u16 ssb_sdio_read16(struct ssb_device *dev, u16 offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) struct ssb_bus *bus = dev->bus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) u16 val = 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) sdio_claim_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) if (unlikely(ssb_sdio_switch_core(bus, dev)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) offset |= bus->sdio_sbaddr & 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) offset &= SBSDIO_SB_OFT_ADDR_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) val = sdio_readw(bus->host_sdio, offset, &error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) dev_dbg(ssb_sdio_dev(bus), "%04X:%04X > %04x, error %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) bus->sdio_sbaddr >> 16, offset, val, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) sdio_release_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) static u32 ssb_sdio_read32(struct ssb_device *dev, u16 offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) struct ssb_bus *bus = dev->bus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) u32 val = 0xffffffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) sdio_claim_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) if (unlikely(ssb_sdio_switch_core(bus, dev)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) offset |= bus->sdio_sbaddr & 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) offset &= SBSDIO_SB_OFT_ADDR_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) offset |= SBSDIO_SB_ACCESS_2_4B_FLAG; /* 32 bit data access */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) val = sdio_readl(bus->host_sdio, offset, &error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) dev_dbg(ssb_sdio_dev(bus), "%04X:%04X > %08x, error %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) bus->sdio_sbaddr >> 16, offset, val, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) sdio_release_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) #ifdef CONFIG_SSB_BLOCKIO
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) static void ssb_sdio_block_read(struct ssb_device *dev, void *buffer,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) size_t count, u16 offset, u8 reg_width)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) size_t saved_count = count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) struct ssb_bus *bus = dev->bus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) sdio_claim_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) if (unlikely(ssb_sdio_switch_core(bus, dev))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) error = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) memset(buffer, 0xff, count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) goto err_out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) offset |= bus->sdio_sbaddr & 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) offset &= SBSDIO_SB_OFT_ADDR_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) switch (reg_width) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) case sizeof(u8): {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) error = sdio_readsb(bus->host_sdio, buffer, offset, count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) case sizeof(u16): {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) WARN_ON(count & 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) error = sdio_readsb(bus->host_sdio, buffer, offset, count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) case sizeof(u32): {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) WARN_ON(count & 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) offset |= SBSDIO_SB_ACCESS_2_4B_FLAG; /* 32 bit data access */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) error = sdio_readsb(bus->host_sdio, buffer, offset, count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) WARN_ON(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) if (!error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) err_out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) dev_dbg(ssb_sdio_dev(bus), "%04X:%04X (width=%u, len=%zu), error %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) bus->sdio_sbaddr >> 16, offset, reg_width, saved_count, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) sdio_release_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) #endif /* CONFIG_SSB_BLOCKIO */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) static void ssb_sdio_write8(struct ssb_device *dev, u16 offset, u8 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) struct ssb_bus *bus = dev->bus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) sdio_claim_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) if (unlikely(ssb_sdio_switch_core(bus, dev)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) offset |= bus->sdio_sbaddr & 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) offset &= SBSDIO_SB_OFT_ADDR_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) sdio_writeb(bus->host_sdio, val, offset, &error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) dev_dbg(ssb_sdio_dev(bus), "%04X:%04X < %02x, error %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) bus->sdio_sbaddr >> 16, offset, val, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) sdio_release_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) static void ssb_sdio_write16(struct ssb_device *dev, u16 offset, u16 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) struct ssb_bus *bus = dev->bus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) sdio_claim_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) if (unlikely(ssb_sdio_switch_core(bus, dev)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) offset |= bus->sdio_sbaddr & 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) offset &= SBSDIO_SB_OFT_ADDR_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) sdio_writew(bus->host_sdio, val, offset, &error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) dev_dbg(ssb_sdio_dev(bus), "%04X:%04X < %04x, error %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) bus->sdio_sbaddr >> 16, offset, val, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) sdio_release_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) static void ssb_sdio_write32(struct ssb_device *dev, u16 offset, u32 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) struct ssb_bus *bus = dev->bus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) sdio_claim_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) if (unlikely(ssb_sdio_switch_core(bus, dev)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) offset |= bus->sdio_sbaddr & 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) offset &= SBSDIO_SB_OFT_ADDR_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) offset |= SBSDIO_SB_ACCESS_2_4B_FLAG; /* 32 bit data access */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) sdio_writel(bus->host_sdio, val, offset, &error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) dev_dbg(ssb_sdio_dev(bus), "%04X:%04X < %08x, error %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) bus->sdio_sbaddr >> 16, offset, val, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) if (bus->quirks & SSB_QUIRK_SDIO_READ_AFTER_WRITE32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) sdio_readl(bus->host_sdio, 0, &error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) sdio_release_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) #ifdef CONFIG_SSB_BLOCKIO
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) static void ssb_sdio_block_write(struct ssb_device *dev, const void *buffer,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) size_t count, u16 offset, u8 reg_width)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) size_t saved_count = count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) struct ssb_bus *bus = dev->bus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) sdio_claim_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) if (unlikely(ssb_sdio_switch_core(bus, dev))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) error = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) goto err_out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) offset |= bus->sdio_sbaddr & 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) offset &= SBSDIO_SB_OFT_ADDR_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) switch (reg_width) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) case sizeof(u8):
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) error = sdio_writesb(bus->host_sdio, offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) (void *)buffer, count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) case sizeof(u16):
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) WARN_ON(count & 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) error = sdio_writesb(bus->host_sdio, offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) (void *)buffer, count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) case sizeof(u32):
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) WARN_ON(count & 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) offset |= SBSDIO_SB_ACCESS_2_4B_FLAG; /* 32 bit data access */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) error = sdio_writesb(bus->host_sdio, offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) (void *)buffer, count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) WARN_ON(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) if (!error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) err_out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) dev_dbg(ssb_sdio_dev(bus), "%04X:%04X (width=%u, len=%zu), error %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) bus->sdio_sbaddr >> 16, offset, reg_width, saved_count, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) sdio_release_host(bus->host_sdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) #endif /* CONFIG_SSB_BLOCKIO */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) /* Not "static", as it's used in main.c */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) const struct ssb_bus_ops ssb_sdio_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) .read8 = ssb_sdio_read8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) .read16 = ssb_sdio_read16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) .read32 = ssb_sdio_read32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) .write8 = ssb_sdio_write8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) .write16 = ssb_sdio_write16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) .write32 = ssb_sdio_write32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) #ifdef CONFIG_SSB_BLOCKIO
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) .block_read = ssb_sdio_block_read,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) .block_write = ssb_sdio_block_write,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) #define GOTO_ERROR_ON(condition, description) do { \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) if (unlikely(condition)) { \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) error_description = description; \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) goto error; \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) } \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) } while (0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) int ssb_sdio_get_invariants(struct ssb_bus *bus,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) struct ssb_init_invariants *iv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) struct ssb_sprom *sprom = &iv->sprom;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) struct ssb_boardinfo *bi = &iv->boardinfo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) const char *error_description = "none";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) struct sdio_func_tuple *tuple;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) void *mac;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) memset(sprom, 0xFF, sizeof(*sprom));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) sprom->boardflags_lo = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) sprom->boardflags_hi = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) tuple = bus->host_sdio->tuples;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) while (tuple) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) switch (tuple->code) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) case 0x22: /* extended function */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) switch (tuple->data[0]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) case CISTPL_FUNCE_LAN_NODE_ID:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) GOTO_ERROR_ON((tuple->size != 7) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) (tuple->data[1] != 6),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) "mac tpl size");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) /* fetch the MAC address. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) mac = tuple->data + 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) memcpy(sprom->il0mac, mac, ETH_ALEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) memcpy(sprom->et1mac, mac, ETH_ALEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) case 0x80: /* vendor specific tuple */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) switch (tuple->data[0]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) case SSB_SDIO_CIS_SROMREV:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) GOTO_ERROR_ON(tuple->size != 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) "sromrev tpl size");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) sprom->revision = tuple->data[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) case SSB_SDIO_CIS_ID:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) GOTO_ERROR_ON((tuple->size != 5) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) (tuple->size != 7),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) "id tpl size");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) bi->vendor = tuple->data[1] |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) (tuple->data[2]<<8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) case SSB_SDIO_CIS_BOARDREV:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) GOTO_ERROR_ON(tuple->size != 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) "boardrev tpl size");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) sprom->board_rev = tuple->data[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) case SSB_SDIO_CIS_PA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) GOTO_ERROR_ON((tuple->size != 9) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) (tuple->size != 10),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) "pa tpl size");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) sprom->pa0b0 = tuple->data[1] |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) ((u16)tuple->data[2] << 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) sprom->pa0b1 = tuple->data[3] |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) ((u16)tuple->data[4] << 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) sprom->pa0b2 = tuple->data[5] |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) ((u16)tuple->data[6] << 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) sprom->itssi_a = tuple->data[7];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) sprom->itssi_bg = tuple->data[7];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) sprom->maxpwr_a = tuple->data[8];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) sprom->maxpwr_bg = tuple->data[8];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) case SSB_SDIO_CIS_OEMNAME:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) /* Not present */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) case SSB_SDIO_CIS_CCODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) GOTO_ERROR_ON(tuple->size != 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) "ccode tpl size");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) sprom->country_code = tuple->data[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) case SSB_SDIO_CIS_ANTENNA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) GOTO_ERROR_ON(tuple->size != 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) "ant tpl size");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) sprom->ant_available_a = tuple->data[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) sprom->ant_available_bg = tuple->data[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) case SSB_SDIO_CIS_ANTGAIN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) GOTO_ERROR_ON(tuple->size != 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) "antg tpl size");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) sprom->antenna_gain.a0 = tuple->data[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) sprom->antenna_gain.a1 = tuple->data[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) sprom->antenna_gain.a2 = tuple->data[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) sprom->antenna_gain.a3 = tuple->data[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) case SSB_SDIO_CIS_BFLAGS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) GOTO_ERROR_ON((tuple->size != 3) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) (tuple->size != 5),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) "bfl tpl size");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) sprom->boardflags_lo = tuple->data[1] |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) ((u16)tuple->data[2] << 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) case SSB_SDIO_CIS_LEDS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) GOTO_ERROR_ON(tuple->size != 5,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) "leds tpl size");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) sprom->gpio0 = tuple->data[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) sprom->gpio1 = tuple->data[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) sprom->gpio2 = tuple->data[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) sprom->gpio3 = tuple->data[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) tuple = tuple->next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) dev_err(ssb_sdio_dev(bus), "failed to fetch device invariants: %s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) error_description);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) void ssb_sdio_exit(struct ssb_bus *bus)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) if (bus->bustype != SSB_BUSTYPE_SDIO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) /* Nothing to do here. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) int ssb_sdio_init(struct ssb_bus *bus)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) if (bus->bustype != SSB_BUSTYPE_SDIO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) bus->sdio_sbaddr = ~0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags