Changes in 4.9.269 net: usb: ax88179_178a: initialize local variables before use iwlwifi: Fix softirq/hardirq disabling in iwl_pcie_enqueue_hcmd() ALSA: usb-audio: Add MIDI quirk for Vox ToneLab EX USB: Add LPM quirk for Lenovo ThinkPad USB-C Dock Gen2 Ethernet USB: Add reset-resume quirk for WD19's Realtek Hub platform/x86: thinkpad_acpi: Correct thermal sensor allocation s390/disassembler: increase ebpf disasm buffer size ACPI: custom_method: fix potential use-after-free issue ACPI: custom_method: fix a possible memory leak arm64: dts: mt8173: fix property typo of 'phys' in dsi node ecryptfs: fix kernel panic with null dev_name mmc: core: Do a power cycle when the CMD11 fails mmc: core: Set read only for SD cards with permanent write protect bit btrfs: fix metadata extent leak after failure to create subvolume fbdev: zero-fill colormap in fbcmap.c staging: wimax/i2400m: fix byte-order issue usb: gadget: uvc: add bInterval checking for HS mode usb: dwc3: gadget: Ignore EP queue requests during bus reset usb: xhci: Fix port minor revision PCI: PM: Do not read power state in pci_enable_device_flags() x86/build: Propagate $(CLANG_FLAGS) to $(REALMODE_FLAGS) spi: dln2: Fix reference leak to master spi: omap-100k: Fix reference leak to master intel_th: Consistency and off-by-one fix phy: phy-twl4030-usb: Fix possible use-after-free in twl4030_usb_remove() btrfs: convert logic BUG_ON()'s in replace_path to ASSERT()'s scsi: target: pscsi: Fix warning in pscsi_complete_cmd() media: ite-cir: check for receive overflow extcon: arizona: Fix some issues when HPDET IRQ fires after the jack has been unplugged media: media/saa7164: fix saa7164_encoder_register() memory leak bugs media: gspca/sq905.c: fix uninitialized variable power: supply: Use IRQF_ONESHOT scsi: qla2xxx: Always check the return value of qla24xx_get_isp_stats() scsi: scsi_dh_alua: Remove check for ASC 24h in alua_rtpg() media: em28xx: fix memory leak clk: socfpga: arria10: Fix memory leak of socfpga_clk on error return power: supply: generic-adc-battery: fix possible use-after-free in gab_remove() power: supply: s3c_adc_battery: fix possible use-after-free in s3c_adc_bat_remove() media: adv7604: fix possible use-after-free in adv76xx_remove() media: i2c: adv7511-v4l2: fix possible use-after-free in adv7511_remove() media: i2c: adv7842: fix possible use-after-free in adv7842_remove() media: dvb-usb: fix memory leak in dvb_usb_adapter_init media: gscpa/stv06xx: fix memory leak drm/msm/mdp5: Configure PP_SYNC_HEIGHT to double the vtotal drm/amdgpu: fix NULL pointer dereference scsi: lpfc: Fix crash when a REG_RPI mailbox fails triggering a LOGO response scsi: libfc: Fix a format specifier ALSA: emu8000: Fix a use after free in snd_emu8000_create_mixer ALSA: sb: Fix two use after free in snd_sb_qsound_build arm64/vdso: Discard .note.gnu.property sections in vDSO openvswitch: fix stack OOB read while fragmenting IPv4 packets NFSv4: Don't discard segments marked for return in _pnfs_return_layout() jffs2: Fix kasan slab-out-of-bounds problem powerpc/eeh: Fix EEH handling for hugepages in ioremap space. powerpc: fix EDEADLOCK redefinition error in uapi/asm/errno.h jffs2: check the validity of dstlen in jffs2_zlib_compress() Revert 337f13046ff0 ("futex: Allow FUTEX_CLOCK_REALTIME with FUTEX_WAIT op") ftrace: Handle commands when closing set_ftrace_filter file ext4: fix check to prevent false positive report of incorrect used inodes ext4: fix error code in ext4_commit_super media: dvbdev: Fix memory leak in dvb_media_device_free() usb: gadget: dummy_hcd: fix gpf in gadget_setup usb: gadget: Fix double free of device descriptor pointers usb: gadget/function/f_fs string table fix for multiple languages dm persistent data: packed struct should have an aligned() attribute too dm space map common: fix division bug in sm_ll_find_free_block() dm rq: fix double free of blk_mq_tag_set in dev remove after table load fails Bluetooth: verify AMP hci_chan before amp_destroy hsr: use netdev_err() instead of WARN_ONCE() bluetooth: eliminate the potential race condition when removing the HCI controller net/nfc: fix use-after-free llcp_sock_bind/connect FDDI: defxx: Bail out gracefully with unassigned PCI resource for CSR misc: lis3lv02d: Fix false-positive WARN on various HP models misc: vmw_vmci: explicitly initialize vmci_notify_bm_set_msg struct misc: vmw_vmci: explicitly initialize vmci_datagram payload tracing: Treat recording comm for idle task as a success tracing: Use strlcpy() instead of strcpy() in __trace_find_cmdline() tracing: Map all PIDs to command lines tracing: Restructure trace_clock_global() to never block md-cluster: fix use-after-free issue when removing rdev md: factor out a mddev_find_locked helper from mddev_find md: md_open returns -EBUSY when entering racing area ipw2x00: potential buffer overflow in libipw_wx_set_encodeext() cfg80211: scan: drop entry from hidden_list on overflow drm/radeon: fix copy of uninitialized variable back to userspace ALSA: hda/realtek: Re-order ALC882 Acer quirk table entries ALSA: hda/realtek: Re-order ALC882 Sony quirk table entries ALSA: hda/realtek: Re-order ALC269 Sony quirk table entries ALSA: hda/realtek: Re-order ALC269 Lenovo quirk table entries ALSA: hda/realtek: Remove redundant entry for ALC861 Haier/Uniwill devices usb: gadget: pch_udc: Revert d3cb25a12138 completely memory: gpmc: fix out of bounds read and dereference on gpmc_cs[] ARM: dts: exynos: correct PMIC interrupt trigger level on SMDK5250 ARM: dts: exynos: correct PMIC interrupt trigger level on Snow serial: stm32: fix incorrect characters on console usb: gadget: pch_udc: Replace cpu_to_le32() by lower_32_bits() usb: gadget: pch_udc: Check if driver is present before calling ->setup() usb: gadget: pch_udc: Check for DMA mapping error crypto: qat - don't release uninitialized resources crypto: qat - ADF_STATUS_PF_RUNNING should be set after adf_dev_init fotg210-udc: Fix DMA on EP0 for length > max packet size fotg210-udc: Fix EP0 IN requests bigger than two packets fotg210-udc: Remove a dubious condition leading to fotg210_done fotg210-udc: Mask GRP2 interrupts we don't handle fotg210-udc: Don't DMA more than the buffer can take fotg210-udc: Complete OUT requests on short packets mtd: require write permissions for locking and badblock ioctls bus: qcom: Put child node before return crypto: qat - fix error path in adf_isr_resource_alloc() mtd: rawnand: gpmi: Fix a double free in gpmi_nand_init staging: rtl8192u: Fix potential infinite loop staging: greybus: uart: fix unprivileged TIOCCSERIAL crypto: qat - Fix a double free in adf_create_ring usb: gadget: r8a66597: Add missing null check on return from platform_get_resource USB: cdc-acm: fix unprivileged TIOCCSERIAL tty: actually undefine superseded ASYNC flags tty: fix return value for unsupported ioctls firmware: qcom-scm: Fix QCOM_SCM configuration x86/platform/uv: Fix !KEXEC build failure Drivers: hv: vmbus: Increase wait time for VMbus unload ttyprintk: Add TTY hangup callback. media: vivid: fix assignment of dev->fbuf_out_flags media: omap4iss: return error code when omap4iss_get() failed media: m88rs6000t: avoid potential out-of-bounds reads on arrays pata_arasan_cf: fix IRQ check pata_ipx4xx_cf: fix IRQ check sata_mv: add IRQ checks ata: libahci_platform: fix IRQ check scsi: fcoe: Fix mismatched fcoe_wwn_from_mac declaration media: dvb-usb-remote: fix dvb_usb_nec_rc_key_to_event type mismatch clk: uniphier: Fix potential infinite loop scsi: jazz_esp: Add IRQ check scsi: sun3x_esp: Add IRQ check scsi: sni_53c710: Add IRQ check HSI: core: fix resource leaks in hsi_add_client_from_dt() x86/events/amd/iommu: Fix sysfs type mismatch HID: plantronics: Workaround for double volume key presses perf symbols: Fix dso__fprintf_symbols_by_name() to return the number of printed chars net: lapbether: Prevent racing when checking whether the netif is running powerpc/prom: Mark identical_pvr_fixup as __init ALSA: core: remove redundant spin_lock pair in snd_card_disconnect nfc: pn533: prevent potential memory corruption ALSA: usb-audio: Add error checks for usb_driver_claim_interface() calls liquidio: Fix unintented sign extension of a left shift of a u16 powerpc/perf: Fix PMU constraint check for EBB events powerpc: iommu: fix build when neither PCI or IBMVIO is set mac80211: bail out if cipher schemes are invalid mt7601u: fix always true expression net: thunderx: Fix unintentional sign extension issue i2c: cadence: add IRQ check i2c: emev2: add IRQ check i2c: jz4780: add IRQ check i2c: sh7760: add IRQ check MIPS: pci-legacy: stop using of_pci_range_to_resource powerpc/pseries: extract host bridge from pci_bus prior to bus removal i2c: sh7760: fix IRQ error path mwl8k: Fix a double Free in mwl8k_probe_hw vsock/vmci: log once the failed queue pair allocation RDMA/i40iw: Fix error unwinding when i40iw_hmc_sd_one fails net: davinci_emac: Fix incorrect masking of tx and rx error channel ath9k: Fix error check in ath9k_hw_read_revisions() for PCI devices powerpc/52xx: Fix an invalid ASM expression ('addi' used instead of 'add') net:emac/emac-mac: Fix a use after free in emac_mac_tx_buf_send net:nfc:digital: Fix a double free in digital_tg_recv_dep_req kfifo: fix ternary sign extension bugs Revert "net/sctp: fix race condition in sctp_destroy_sock" sctp: delay auto_asconf init until binding the first addr Revert "of/fdt: Make sure no-map does not remove already reserved regions" Revert "fdt: Properly handle "no-map" field in the memory region" fs: dlm: fix debugfs dump tipc: convert dest node's address to network order net: stmmac: Set FIFO sizes for ipq806x ALSA: hdsp: don't disable if not enabled ALSA: hdspm: don't disable if not enabled ALSA: rme9652: don't disable if not enabled Bluetooth: Set CONF_NOT_COMPLETE as l2cap_chan default Bluetooth: initialize skb_queue_head at l2cap_chan_create() ip6_vti: proper dev_{hold|put} in ndo_[un]init methods mac80211: clear the beacon's CRC after channel switch cuse: prevent clone selftests: Set CC to clang in lib.mk if LLVM is set kconfig: nconf: stop endless search loops sctp: Fix out-of-bounds warning in sctp_process_asconf_param() ASoC: rt286: Generalize support for ALC3263 codec samples/bpf: Fix broken tracex1 due to kprobe argument change powerpc/pseries: Stop calling printk in rtas_stop_self() wl3501_cs: Fix out-of-bounds warnings in wl3501_send_pkt wl3501_cs: Fix out-of-bounds warnings in wl3501_mgmt_join powerpc/iommu: Annotate nested lock for lockdep net: ethernet: mtk_eth_soc: fix RX VLAN offload ASoC: rt286: Make RT286_SET_GPIO_* readable and writable f2fs: fix a redundant call to f2fs_balance_fs if an error occurs PCI: Release OF node in pci_scan_device()'s error path ARM: 9064/1: hw_breakpoint: Do not directly check the event's overflow_handler hook NFSv4.2: Always flush out writes in nfs42_proc_fallocate() NFS: Deal correctly with attribute generation counter overflow pNFS/flexfiles: fix incorrect size check in decode_nfs_fh() NFSv4.2 fix handling of sr_eof in SEEK's reply sctp: fix a SCTP_MIB_CURRESTAB leak in sctp_sf_do_dupcook_b drm/radeon: Fix off-by-one power_state index heap overwrite khugepaged: fix wrong result value for trace_mm_collapse_huge_page_isolate() mm/hugeltb: handle the error case in hugetlb_fix_reserve_counts() ksm: fix potential missing rmap_item for stable_node kernel: kexec_file: fix error return code of kexec_calculate_store_digests() ARC: entry: fix off-by-one error in syscall number validation powerpc/64s: Fix crashes when toggling entry flush barrier squashfs: fix divide error in calculate_skip() iio: proximity: pulsedlight: Fix rumtime PM imbalance on error usb: fotg210-hcd: Fix an error message ACPI: scan: Fix a memory leak in an error handling path usb: xhci: Increase timeout for HC halt usb: dwc2: Fix gadget DMA unmap direction usb: core: hub: fix race condition about TRSMRCY of resume KVM: x86: Cancel pvclock_gtod_work on module removal FDDI: defxx: Make MMIO the configuration default except for EISA MIPS: Reinstate platform `__div64_32' handler MIPS: Avoid DIVU in `__div64_32' is result would be zero MIPS: Avoid handcoded DIVU in `__div64_32' altogether thermal/core/fair share: Lock the thermal zone while looping over instances dm ioctl: fix out of bounds array access when no devices kobject_uevent: remove warning in init_uevent_argv() netfilter: conntrack: Make global sysctls readonly in non-init netns clk: exynos7: Mark aclk_fsys1_200 as critical x86/msr: Fix wr/rdmsr_safe_regs_on_cpu() prototypes extcon: adc-jack: Fix incompatible pointer type warning kgdb: fix gcc-11 warning on indentation usb: sl811-hcd: improve misleading indentation cxgb4: Fix the -Wmisleading-indentation warning isdn: capi: fix mismatched prototypes ACPI / hotplug / PCI: Fix reference count leak in enable_slot() Input: silead - add workaround for x86 BIOS-es which bring the chip up in a stuck state um: Mark all kernel symbols as local ceph: fix fscache invalidation ALSA: hda: generic: change the DAC ctl name for LO+SPK or LO+HP lib: stackdepot: turn depot_lock spinlock to raw_spinlock sit: proper dev_{hold|put} in ndo_[un]init methods ip6_tunnel: sit: proper dev_{hold|put} in ndo_[un]init methods xhci: Do not use GFP_KERNEL in (potentially) atomic context ipv6: remove extra dev_hold() for fallback tunnels Linux 4.9.269 Signed-off-by: Greg Kroah-Hartman <gregkh@google.com> Change-Id: Ib994aef2c6746afa8dcbb237d8c0645ba2c6f7e1
566 lines
13 KiB
C
566 lines
13 KiB
C
/*
|
|
* I2C bus driver for the SH7760 I2C Interfaces.
|
|
*
|
|
* (c) 2005-2008 MSC Vertriebsges.m.b.H, Manuel Lauss <mlau@msc-ge.com>
|
|
*
|
|
* licensed under the terms outlined in the file COPYING.
|
|
*
|
|
*/
|
|
|
|
#include <linux/completion.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/err.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/io.h>
|
|
#include <linux/module.h>
|
|
|
|
#include <asm/clock.h>
|
|
#include <asm/i2c-sh7760.h>
|
|
|
|
/* register offsets */
|
|
#define I2CSCR 0x0 /* slave ctrl */
|
|
#define I2CMCR 0x4 /* master ctrl */
|
|
#define I2CSSR 0x8 /* slave status */
|
|
#define I2CMSR 0xC /* master status */
|
|
#define I2CSIER 0x10 /* slave irq enable */
|
|
#define I2CMIER 0x14 /* master irq enable */
|
|
#define I2CCCR 0x18 /* clock dividers */
|
|
#define I2CSAR 0x1c /* slave address */
|
|
#define I2CMAR 0x20 /* master address */
|
|
#define I2CRXTX 0x24 /* data port */
|
|
#define I2CFCR 0x28 /* fifo control */
|
|
#define I2CFSR 0x2C /* fifo status */
|
|
#define I2CFIER 0x30 /* fifo irq enable */
|
|
#define I2CRFDR 0x34 /* rx fifo count */
|
|
#define I2CTFDR 0x38 /* tx fifo count */
|
|
|
|
#define REGSIZE 0x3C
|
|
|
|
#define MCR_MDBS 0x80 /* non-fifo mode switch */
|
|
#define MCR_FSCL 0x40 /* override SCL pin */
|
|
#define MCR_FSDA 0x20 /* override SDA pin */
|
|
#define MCR_OBPC 0x10 /* override pins */
|
|
#define MCR_MIE 0x08 /* master if enable */
|
|
#define MCR_TSBE 0x04
|
|
#define MCR_FSB 0x02 /* force stop bit */
|
|
#define MCR_ESG 0x01 /* en startbit gen. */
|
|
|
|
#define MSR_MNR 0x40 /* nack received */
|
|
#define MSR_MAL 0x20 /* arbitration lost */
|
|
#define MSR_MST 0x10 /* sent a stop */
|
|
#define MSR_MDE 0x08
|
|
#define MSR_MDT 0x04
|
|
#define MSR_MDR 0x02
|
|
#define MSR_MAT 0x01 /* slave addr xfer done */
|
|
|
|
#define MIE_MNRE 0x40 /* nack irq en */
|
|
#define MIE_MALE 0x20 /* arblos irq en */
|
|
#define MIE_MSTE 0x10 /* stop irq en */
|
|
#define MIE_MDEE 0x08
|
|
#define MIE_MDTE 0x04
|
|
#define MIE_MDRE 0x02
|
|
#define MIE_MATE 0x01 /* address sent irq en */
|
|
|
|
#define FCR_RFRST 0x02 /* reset rx fifo */
|
|
#define FCR_TFRST 0x01 /* reset tx fifo */
|
|
|
|
#define FSR_TEND 0x04 /* last byte sent */
|
|
#define FSR_RDF 0x02 /* rx fifo trigger */
|
|
#define FSR_TDFE 0x01 /* tx fifo empty */
|
|
|
|
#define FIER_TEIE 0x04 /* tx fifo empty irq en */
|
|
#define FIER_RXIE 0x02 /* rx fifo trig irq en */
|
|
#define FIER_TXIE 0x01 /* tx fifo trig irq en */
|
|
|
|
#define FIFO_SIZE 16
|
|
|
|
struct cami2c {
|
|
void __iomem *iobase;
|
|
struct i2c_adapter adap;
|
|
|
|
/* message processing */
|
|
struct i2c_msg *msg;
|
|
#define IDF_SEND 1
|
|
#define IDF_RECV 2
|
|
#define IDF_STOP 4
|
|
int flags;
|
|
|
|
#define IDS_DONE 1
|
|
#define IDS_ARBLOST 2
|
|
#define IDS_NACK 4
|
|
int status;
|
|
struct completion xfer_done;
|
|
|
|
int irq;
|
|
struct resource *ioarea;
|
|
};
|
|
|
|
static inline void OUT32(struct cami2c *cam, int reg, unsigned long val)
|
|
{
|
|
__raw_writel(val, (unsigned long)cam->iobase + reg);
|
|
}
|
|
|
|
static inline unsigned long IN32(struct cami2c *cam, int reg)
|
|
{
|
|
return __raw_readl((unsigned long)cam->iobase + reg);
|
|
}
|
|
|
|
static irqreturn_t sh7760_i2c_irq(int irq, void *ptr)
|
|
{
|
|
struct cami2c *id = ptr;
|
|
struct i2c_msg *msg = id->msg;
|
|
char *data = msg->buf;
|
|
unsigned long msr, fsr, fier, len;
|
|
|
|
msr = IN32(id, I2CMSR);
|
|
fsr = IN32(id, I2CFSR);
|
|
|
|
/* arbitration lost */
|
|
if (msr & MSR_MAL) {
|
|
OUT32(id, I2CMCR, 0);
|
|
OUT32(id, I2CSCR, 0);
|
|
OUT32(id, I2CSAR, 0);
|
|
id->status |= IDS_DONE | IDS_ARBLOST;
|
|
goto out;
|
|
}
|
|
|
|
if (msr & MSR_MNR) {
|
|
/* NACK handling is very screwed up. After receiving a
|
|
* NAK IRQ one has to wait a bit before writing to any
|
|
* registers, or the ctl will lock up. After that delay
|
|
* do a normal i2c stop. Then wait at least 1 ms before
|
|
* attempting another transfer or ctl will stop working
|
|
*/
|
|
udelay(100); /* wait or risk ctl hang */
|
|
OUT32(id, I2CFCR, FCR_RFRST | FCR_TFRST);
|
|
OUT32(id, I2CMCR, MCR_MIE | MCR_FSB);
|
|
OUT32(id, I2CFIER, 0);
|
|
OUT32(id, I2CMIER, MIE_MSTE);
|
|
OUT32(id, I2CSCR, 0);
|
|
OUT32(id, I2CSAR, 0);
|
|
id->status |= IDS_NACK;
|
|
msr &= ~MSR_MAT;
|
|
fsr = 0;
|
|
/* In some cases the MST bit is also set. */
|
|
}
|
|
|
|
/* i2c-stop was sent */
|
|
if (msr & MSR_MST) {
|
|
id->status |= IDS_DONE;
|
|
goto out;
|
|
}
|
|
|
|
/* i2c slave addr was sent; set to "normal" operation */
|
|
if (msr & MSR_MAT)
|
|
OUT32(id, I2CMCR, MCR_MIE);
|
|
|
|
fier = IN32(id, I2CFIER);
|
|
|
|
if (fsr & FSR_RDF) {
|
|
len = IN32(id, I2CRFDR);
|
|
if (msg->len <= len) {
|
|
if (id->flags & IDF_STOP) {
|
|
OUT32(id, I2CMCR, MCR_MIE | MCR_FSB);
|
|
OUT32(id, I2CFIER, 0);
|
|
/* manual says: wait >= 0.5 SCL times */
|
|
udelay(5);
|
|
/* next int should be MST */
|
|
} else {
|
|
id->status |= IDS_DONE;
|
|
/* keep the RDF bit: ctrl holds SCL low
|
|
* until the setup for the next i2c_msg
|
|
* clears this bit.
|
|
*/
|
|
fsr &= ~FSR_RDF;
|
|
}
|
|
}
|
|
while (msg->len && len) {
|
|
*data++ = IN32(id, I2CRXTX);
|
|
msg->len--;
|
|
len--;
|
|
}
|
|
|
|
if (msg->len) {
|
|
len = (msg->len >= FIFO_SIZE) ? FIFO_SIZE - 1
|
|
: msg->len - 1;
|
|
|
|
OUT32(id, I2CFCR, FCR_TFRST | ((len & 0xf) << 4));
|
|
}
|
|
|
|
} else if (id->flags & IDF_SEND) {
|
|
if ((fsr & FSR_TEND) && (msg->len < 1)) {
|
|
if (id->flags & IDF_STOP) {
|
|
OUT32(id, I2CMCR, MCR_MIE | MCR_FSB);
|
|
} else {
|
|
id->status |= IDS_DONE;
|
|
/* keep the TEND bit: ctl holds SCL low
|
|
* until the setup for the next i2c_msg
|
|
* clears this bit.
|
|
*/
|
|
fsr &= ~FSR_TEND;
|
|
}
|
|
}
|
|
if (fsr & FSR_TDFE) {
|
|
while (msg->len && (IN32(id, I2CTFDR) < FIFO_SIZE)) {
|
|
OUT32(id, I2CRXTX, *data++);
|
|
msg->len--;
|
|
}
|
|
|
|
if (msg->len < 1) {
|
|
fier &= ~FIER_TXIE;
|
|
OUT32(id, I2CFIER, fier);
|
|
} else {
|
|
len = (msg->len >= FIFO_SIZE) ? 2 : 0;
|
|
OUT32(id, I2CFCR,
|
|
FCR_RFRST | ((len & 3) << 2));
|
|
}
|
|
}
|
|
}
|
|
out:
|
|
if (id->status & IDS_DONE) {
|
|
OUT32(id, I2CMIER, 0);
|
|
OUT32(id, I2CFIER, 0);
|
|
id->msg = NULL;
|
|
complete(&id->xfer_done);
|
|
}
|
|
/* clear status flags and ctrl resumes work */
|
|
OUT32(id, I2CMSR, ~msr);
|
|
OUT32(id, I2CFSR, ~fsr);
|
|
OUT32(id, I2CSSR, 0);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
|
|
/* prepare and start a master receive operation */
|
|
static void sh7760_i2c_mrecv(struct cami2c *id)
|
|
{
|
|
int len;
|
|
|
|
id->flags |= IDF_RECV;
|
|
|
|
/* set the slave addr reg; otherwise rcv wont work! */
|
|
OUT32(id, I2CSAR, 0xfe);
|
|
OUT32(id, I2CMAR, (id->msg->addr << 1) | 1);
|
|
|
|
/* adjust rx fifo trigger */
|
|
if (id->msg->len >= FIFO_SIZE)
|
|
len = FIFO_SIZE - 1; /* trigger at fifo full */
|
|
else
|
|
len = id->msg->len - 1; /* trigger before all received */
|
|
|
|
OUT32(id, I2CFCR, FCR_RFRST | FCR_TFRST);
|
|
OUT32(id, I2CFCR, FCR_TFRST | ((len & 0xF) << 4));
|
|
|
|
OUT32(id, I2CMSR, 0);
|
|
OUT32(id, I2CMCR, MCR_MIE | MCR_ESG);
|
|
OUT32(id, I2CMIER, MIE_MNRE | MIE_MALE | MIE_MSTE | MIE_MATE);
|
|
OUT32(id, I2CFIER, FIER_RXIE);
|
|
}
|
|
|
|
/* prepare and start a master send operation */
|
|
static void sh7760_i2c_msend(struct cami2c *id)
|
|
{
|
|
int len;
|
|
|
|
id->flags |= IDF_SEND;
|
|
|
|
/* set the slave addr reg; otherwise xmit wont work! */
|
|
OUT32(id, I2CSAR, 0xfe);
|
|
OUT32(id, I2CMAR, (id->msg->addr << 1) | 0);
|
|
|
|
/* adjust tx fifo trigger */
|
|
if (id->msg->len >= FIFO_SIZE)
|
|
len = 2; /* trig: 2 bytes left in TX fifo */
|
|
else
|
|
len = 0; /* trig: 8 bytes left in TX fifo */
|
|
|
|
OUT32(id, I2CFCR, FCR_RFRST | FCR_TFRST);
|
|
OUT32(id, I2CFCR, FCR_RFRST | ((len & 3) << 2));
|
|
|
|
while (id->msg->len && IN32(id, I2CTFDR) < FIFO_SIZE) {
|
|
OUT32(id, I2CRXTX, *(id->msg->buf));
|
|
(id->msg->len)--;
|
|
(id->msg->buf)++;
|
|
}
|
|
|
|
OUT32(id, I2CMSR, 0);
|
|
OUT32(id, I2CMCR, MCR_MIE | MCR_ESG);
|
|
OUT32(id, I2CFSR, 0);
|
|
OUT32(id, I2CMIER, MIE_MNRE | MIE_MALE | MIE_MSTE | MIE_MATE);
|
|
OUT32(id, I2CFIER, FIER_TEIE | (id->msg->len ? FIER_TXIE : 0));
|
|
}
|
|
|
|
static inline int sh7760_i2c_busy_check(struct cami2c *id)
|
|
{
|
|
return (IN32(id, I2CMCR) & MCR_FSDA);
|
|
}
|
|
|
|
static int sh7760_i2c_master_xfer(struct i2c_adapter *adap,
|
|
struct i2c_msg *msgs,
|
|
int num)
|
|
{
|
|
struct cami2c *id = adap->algo_data;
|
|
int i, retr;
|
|
|
|
if (sh7760_i2c_busy_check(id)) {
|
|
dev_err(&adap->dev, "sh7760-i2c%d: bus busy!\n", adap->nr);
|
|
return -EBUSY;
|
|
}
|
|
|
|
i = 0;
|
|
while (i < num) {
|
|
retr = adap->retries;
|
|
retry:
|
|
id->flags = ((i == (num-1)) ? IDF_STOP : 0);
|
|
id->status = 0;
|
|
id->msg = msgs;
|
|
init_completion(&id->xfer_done);
|
|
|
|
if (msgs->flags & I2C_M_RD)
|
|
sh7760_i2c_mrecv(id);
|
|
else
|
|
sh7760_i2c_msend(id);
|
|
|
|
wait_for_completion(&id->xfer_done);
|
|
|
|
if (id->status == 0) {
|
|
num = -EIO;
|
|
break;
|
|
}
|
|
|
|
if (id->status & IDS_NACK) {
|
|
/* wait a bit or i2c module stops working */
|
|
mdelay(1);
|
|
num = -EREMOTEIO;
|
|
break;
|
|
}
|
|
|
|
if (id->status & IDS_ARBLOST) {
|
|
if (retr--) {
|
|
mdelay(2);
|
|
goto retry;
|
|
}
|
|
num = -EREMOTEIO;
|
|
break;
|
|
}
|
|
|
|
msgs++;
|
|
i++;
|
|
}
|
|
|
|
id->msg = NULL;
|
|
id->flags = 0;
|
|
id->status = 0;
|
|
|
|
OUT32(id, I2CMCR, 0);
|
|
OUT32(id, I2CMSR, 0);
|
|
OUT32(id, I2CMIER, 0);
|
|
OUT32(id, I2CFIER, 0);
|
|
|
|
/* reset slave module registers too: master mode enables slave
|
|
* module for receive ops (ack, data). Without this reset,
|
|
* eternal bus activity might be reported after NACK / ARBLOST.
|
|
*/
|
|
OUT32(id, I2CSCR, 0);
|
|
OUT32(id, I2CSAR, 0);
|
|
OUT32(id, I2CSSR, 0);
|
|
|
|
return num;
|
|
}
|
|
|
|
static u32 sh7760_i2c_func(struct i2c_adapter *adap)
|
|
{
|
|
return I2C_FUNC_I2C | (I2C_FUNC_SMBUS_EMUL & ~I2C_FUNC_SMBUS_QUICK);
|
|
}
|
|
|
|
static const struct i2c_algorithm sh7760_i2c_algo = {
|
|
.master_xfer = sh7760_i2c_master_xfer,
|
|
.functionality = sh7760_i2c_func,
|
|
};
|
|
|
|
/* calculate CCR register setting for a desired scl clock. SCL clock is
|
|
* derived from I2C module clock (iclk) which in turn is derived from
|
|
* peripheral module clock (mclk, usually around 33MHz):
|
|
* iclk = mclk/(CDF + 1). iclk must be < 20MHz.
|
|
* scl = iclk/(SCGD*8 + 20).
|
|
*/
|
|
static int calc_CCR(unsigned long scl_hz)
|
|
{
|
|
struct clk *mclk;
|
|
unsigned long mck, m1, dff, odff, iclk;
|
|
signed char cdf, cdfm;
|
|
int scgd, scgdm, scgds;
|
|
|
|
mclk = clk_get(NULL, "peripheral_clk");
|
|
if (IS_ERR(mclk)) {
|
|
return PTR_ERR(mclk);
|
|
} else {
|
|
mck = mclk->rate;
|
|
clk_put(mclk);
|
|
}
|
|
|
|
odff = scl_hz;
|
|
scgdm = cdfm = m1 = 0;
|
|
for (cdf = 3; cdf >= 0; cdf--) {
|
|
iclk = mck / (1 + cdf);
|
|
if (iclk >= 20000000)
|
|
continue;
|
|
scgds = ((iclk / scl_hz) - 20) >> 3;
|
|
for (scgd = scgds; (scgd < 63) && scgd <= scgds + 1; scgd++) {
|
|
m1 = iclk / (20 + (scgd << 3));
|
|
dff = abs(scl_hz - m1);
|
|
if (dff < odff) {
|
|
odff = dff;
|
|
cdfm = cdf;
|
|
scgdm = scgd;
|
|
}
|
|
}
|
|
}
|
|
/* fail if more than 25% off of requested SCL */
|
|
if (odff > (scl_hz >> 2))
|
|
return -EINVAL;
|
|
|
|
/* create a CCR register value */
|
|
return ((scgdm << 2) | cdfm);
|
|
}
|
|
|
|
static int sh7760_i2c_probe(struct platform_device *pdev)
|
|
{
|
|
struct sh7760_i2c_platdata *pd;
|
|
struct resource *res;
|
|
struct cami2c *id;
|
|
int ret;
|
|
|
|
pd = dev_get_platdata(&pdev->dev);
|
|
if (!pd) {
|
|
dev_err(&pdev->dev, "no platform_data!\n");
|
|
ret = -ENODEV;
|
|
goto out0;
|
|
}
|
|
|
|
id = kzalloc(sizeof(struct cami2c), GFP_KERNEL);
|
|
if (!id) {
|
|
dev_err(&pdev->dev, "no mem for private data\n");
|
|
ret = -ENOMEM;
|
|
goto out0;
|
|
}
|
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
if (!res) {
|
|
dev_err(&pdev->dev, "no mmio resources\n");
|
|
ret = -ENODEV;
|
|
goto out1;
|
|
}
|
|
|
|
id->ioarea = request_mem_region(res->start, REGSIZE, pdev->name);
|
|
if (!id->ioarea) {
|
|
dev_err(&pdev->dev, "mmio already reserved\n");
|
|
ret = -EBUSY;
|
|
goto out1;
|
|
}
|
|
|
|
id->iobase = ioremap(res->start, REGSIZE);
|
|
if (!id->iobase) {
|
|
dev_err(&pdev->dev, "cannot ioremap\n");
|
|
ret = -ENODEV;
|
|
goto out2;
|
|
}
|
|
|
|
ret = platform_get_irq(pdev, 0);
|
|
if (ret < 0)
|
|
goto out3;
|
|
id->irq = ret;
|
|
|
|
id->adap.nr = pdev->id;
|
|
id->adap.algo = &sh7760_i2c_algo;
|
|
id->adap.class = I2C_CLASS_HWMON | I2C_CLASS_SPD;
|
|
id->adap.retries = 3;
|
|
id->adap.algo_data = id;
|
|
id->adap.dev.parent = &pdev->dev;
|
|
snprintf(id->adap.name, sizeof(id->adap.name),
|
|
"SH7760 I2C at %08lx", (unsigned long)res->start);
|
|
|
|
OUT32(id, I2CMCR, 0);
|
|
OUT32(id, I2CMSR, 0);
|
|
OUT32(id, I2CMIER, 0);
|
|
OUT32(id, I2CMAR, 0);
|
|
OUT32(id, I2CSIER, 0);
|
|
OUT32(id, I2CSAR, 0);
|
|
OUT32(id, I2CSCR, 0);
|
|
OUT32(id, I2CSSR, 0);
|
|
OUT32(id, I2CFIER, 0);
|
|
OUT32(id, I2CFCR, FCR_RFRST | FCR_TFRST);
|
|
OUT32(id, I2CFSR, 0);
|
|
|
|
ret = calc_CCR(pd->speed_khz * 1000);
|
|
if (ret < 0) {
|
|
dev_err(&pdev->dev, "invalid SCL clock: %dkHz\n",
|
|
pd->speed_khz);
|
|
goto out3;
|
|
}
|
|
OUT32(id, I2CCCR, ret);
|
|
|
|
if (request_irq(id->irq, sh7760_i2c_irq, 0,
|
|
SH7760_I2C_DEVNAME, id)) {
|
|
dev_err(&pdev->dev, "cannot get irq %d\n", id->irq);
|
|
ret = -EBUSY;
|
|
goto out3;
|
|
}
|
|
|
|
ret = i2c_add_numbered_adapter(&id->adap);
|
|
if (ret < 0)
|
|
goto out4;
|
|
|
|
platform_set_drvdata(pdev, id);
|
|
|
|
dev_info(&pdev->dev, "%d kHz mmio %08x irq %d\n",
|
|
pd->speed_khz, res->start, id->irq);
|
|
|
|
return 0;
|
|
|
|
out4:
|
|
free_irq(id->irq, id);
|
|
out3:
|
|
iounmap(id->iobase);
|
|
out2:
|
|
release_resource(id->ioarea);
|
|
kfree(id->ioarea);
|
|
out1:
|
|
kfree(id);
|
|
out0:
|
|
return ret;
|
|
}
|
|
|
|
static int sh7760_i2c_remove(struct platform_device *pdev)
|
|
{
|
|
struct cami2c *id = platform_get_drvdata(pdev);
|
|
|
|
i2c_del_adapter(&id->adap);
|
|
free_irq(id->irq, id);
|
|
iounmap(id->iobase);
|
|
release_resource(id->ioarea);
|
|
kfree(id->ioarea);
|
|
kfree(id);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver sh7760_i2c_drv = {
|
|
.driver = {
|
|
.name = SH7760_I2C_DEVNAME,
|
|
},
|
|
.probe = sh7760_i2c_probe,
|
|
.remove = sh7760_i2c_remove,
|
|
};
|
|
|
|
module_platform_driver(sh7760_i2c_drv);
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_DESCRIPTION("SH7760 I2C bus driver");
|
|
MODULE_AUTHOR("Manuel Lauss <mano@roarinelk.homelinux.net>");
|