forked from mirrors/linux
		
	i2c: Adding support for Intel iSMT SMBus 2.0 host controller
The iSMT (Intel SMBus Message Transport) supports multi-master I2C/SMBus, as well as IPMI. It's operation is DMA-based and utilizes descriptors to initiate transactions on the bus. The iSMT hardware can act as both a master and a target, although this driver only supports being a master. Signed-off-by: Neil Horman <nhorman@tuxdriver.com> Signed-off-by: Bill Brown <bill.e.brown@intel.com> Tested-by: Seth Heasley <seth.heasley@intel.com> Reviewed-by: Jean Delvare <khali@linux-fr.org> Signed-off-by: Wolfram Sang <wolfram@the-dreams.de>
This commit is contained in:
		
							parent
							
								
									e789029761
								
							
						
					
					
						commit
						13f35ac14c
					
				
					 4 changed files with 1010 additions and 0 deletions
				
			
		
							
								
								
									
										36
									
								
								Documentation/i2c/busses/i2c-ismt
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										36
									
								
								Documentation/i2c/busses/i2c-ismt
									
									
									
									
									
										Normal file
									
								
							| 
						 | 
					@ -0,0 +1,36 @@
 | 
				
			||||||
 | 
					Kernel driver i2c-ismt
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					Supported adapters:
 | 
				
			||||||
 | 
					  * Intel S12xx series SOCs
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					Authors:
 | 
				
			||||||
 | 
						Bill Brown <bill.e.brown@intel.com>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					Module Parameters
 | 
				
			||||||
 | 
					-----------------
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					* bus_speed (unsigned int)
 | 
				
			||||||
 | 
					Allows changing of the bus speed.  Normally, the bus speed is set by the BIOS
 | 
				
			||||||
 | 
					and never needs to be changed.  However, some SMBus analyzers are too slow for
 | 
				
			||||||
 | 
					monitoring the bus during debug, thus the need for this module parameter.
 | 
				
			||||||
 | 
					Specify the bus speed in kHz.
 | 
				
			||||||
 | 
					Available bus frequency settings:
 | 
				
			||||||
 | 
					  0  no change
 | 
				
			||||||
 | 
					  80 kHz
 | 
				
			||||||
 | 
					  100 kHz
 | 
				
			||||||
 | 
					  400 kHz
 | 
				
			||||||
 | 
					  1000 kHz
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					Description
 | 
				
			||||||
 | 
					-----------
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					The S12xx series of SOCs have a pair of integrated SMBus 2.0 controllers
 | 
				
			||||||
 | 
					targeted primarily at the microserver and storage markets.
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					The S12xx series contain a pair of PCI functions.  An output of lspci will show
 | 
				
			||||||
 | 
					something similar to the following:
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					  00:13.0 System peripheral: Intel Corporation Centerton SMBus 2.0 Controller 0
 | 
				
			||||||
 | 
					  00:13.1 System peripheral: Intel Corporation Centerton SMBus 2.0 Controller 1
 | 
				
			||||||
| 
						 | 
					@ -122,6 +122,16 @@ config I2C_ISCH
 | 
				
			||||||
	  This driver can also be built as a module. If so, the module
 | 
						  This driver can also be built as a module. If so, the module
 | 
				
			||||||
	  will be called i2c-isch.
 | 
						  will be called i2c-isch.
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					config I2C_ISMT
 | 
				
			||||||
 | 
						tristate "Intel iSMT SMBus Controller"
 | 
				
			||||||
 | 
						depends on PCI && X86
 | 
				
			||||||
 | 
						help
 | 
				
			||||||
 | 
						  If you say yes to this option, support will be included for the Intel
 | 
				
			||||||
 | 
						  iSMT SMBus host controller interface.
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						  This driver can also be built as a module.  If so, the module will be
 | 
				
			||||||
 | 
						  called i2c-ismt.
 | 
				
			||||||
 | 
					
 | 
				
			||||||
config I2C_PIIX4
 | 
					config I2C_PIIX4
 | 
				
			||||||
	tristate "Intel PIIX4 and compatible (ATI/AMD/Serverworks/Broadcom/SMSC)"
 | 
						tristate "Intel PIIX4 and compatible (ATI/AMD/Serverworks/Broadcom/SMSC)"
 | 
				
			||||||
	depends on PCI
 | 
						depends on PCI
 | 
				
			||||||
| 
						 | 
					
 | 
				
			||||||
| 
						 | 
					@ -14,6 +14,7 @@ obj-$(CONFIG_I2C_AMD756_S4882)	+= i2c-amd756-s4882.o
 | 
				
			||||||
obj-$(CONFIG_I2C_AMD8111)	+= i2c-amd8111.o
 | 
					obj-$(CONFIG_I2C_AMD8111)	+= i2c-amd8111.o
 | 
				
			||||||
obj-$(CONFIG_I2C_I801)		+= i2c-i801.o
 | 
					obj-$(CONFIG_I2C_I801)		+= i2c-i801.o
 | 
				
			||||||
obj-$(CONFIG_I2C_ISCH)		+= i2c-isch.o
 | 
					obj-$(CONFIG_I2C_ISCH)		+= i2c-isch.o
 | 
				
			||||||
 | 
					obj-$(CONFIG_I2C_ISMT)		+= i2c-ismt.o
 | 
				
			||||||
obj-$(CONFIG_I2C_NFORCE2)	+= i2c-nforce2.o
 | 
					obj-$(CONFIG_I2C_NFORCE2)	+= i2c-nforce2.o
 | 
				
			||||||
obj-$(CONFIG_I2C_NFORCE2_S4985)	+= i2c-nforce2-s4985.o
 | 
					obj-$(CONFIG_I2C_NFORCE2_S4985)	+= i2c-nforce2-s4985.o
 | 
				
			||||||
obj-$(CONFIG_I2C_PIIX4)		+= i2c-piix4.o
 | 
					obj-$(CONFIG_I2C_PIIX4)		+= i2c-piix4.o
 | 
				
			||||||
| 
						 | 
					
 | 
				
			||||||
							
								
								
									
										963
									
								
								drivers/i2c/busses/i2c-ismt.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										963
									
								
								drivers/i2c/busses/i2c-ismt.c
									
									
									
									
									
										Normal file
									
								
							| 
						 | 
					@ -0,0 +1,963 @@
 | 
				
			||||||
 | 
					/*
 | 
				
			||||||
 | 
					 * This file is provided under a dual BSD/GPLv2 license.  When using or
 | 
				
			||||||
 | 
					 * redistributing this file, you may do so under either license.
 | 
				
			||||||
 | 
					 *
 | 
				
			||||||
 | 
					 * Copyright(c) 2012 Intel Corporation. All rights reserved.
 | 
				
			||||||
 | 
					 *
 | 
				
			||||||
 | 
					 * GPL LICENSE SUMMARY
 | 
				
			||||||
 | 
					 *
 | 
				
			||||||
 | 
					 * This program is free software; you can redistribute it and/or modify
 | 
				
			||||||
 | 
					 * it under the terms of version 2 of the GNU General Public License as
 | 
				
			||||||
 | 
					 * published by the Free Software Foundation.
 | 
				
			||||||
 | 
					 *
 | 
				
			||||||
 | 
					 * This program is distributed in the hope that it will be useful, but
 | 
				
			||||||
 | 
					 * WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
				
			||||||
 | 
					 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 | 
				
			||||||
 | 
					 * General Public License for more details.
 | 
				
			||||||
 | 
					 *
 | 
				
			||||||
 | 
					 * You should have received a copy of the GNU General Public License
 | 
				
			||||||
 | 
					 * along with this program; if not, write to the Free Software
 | 
				
			||||||
 | 
					 * Foundation, Inc., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
 | 
				
			||||||
 | 
					 * The full GNU General Public License is included in this distribution
 | 
				
			||||||
 | 
					 * in the file called LICENSE.GPL.
 | 
				
			||||||
 | 
					 *
 | 
				
			||||||
 | 
					 * BSD LICENSE
 | 
				
			||||||
 | 
					 *
 | 
				
			||||||
 | 
					 * Redistribution and use in source and binary forms, with or without
 | 
				
			||||||
 | 
					 * modification, are permitted provided that the following conditions
 | 
				
			||||||
 | 
					 * are met:
 | 
				
			||||||
 | 
					 *
 | 
				
			||||||
 | 
					 *   * Redistributions of source code must retain the above copyright
 | 
				
			||||||
 | 
					 *     notice, this list of conditions and the following disclaimer.
 | 
				
			||||||
 | 
					 *   * 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.
 | 
				
			||||||
 | 
					 *   * Neither the name of Intel Corporation nor the names of its
 | 
				
			||||||
 | 
					 *     contributors may be used to endorse or promote products derived
 | 
				
			||||||
 | 
					 *     from this software without specific prior written permission.
 | 
				
			||||||
 | 
					 *
 | 
				
			||||||
 | 
					 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS 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 COPYRIGHT
 | 
				
			||||||
 | 
					 * OWNER 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.
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/*
 | 
				
			||||||
 | 
					 *  Supports the SMBus Message Transport (SMT) in the Intel Atom Processor
 | 
				
			||||||
 | 
					 *  S12xx Product Family.
 | 
				
			||||||
 | 
					 *
 | 
				
			||||||
 | 
					 *  Features supported by this driver:
 | 
				
			||||||
 | 
					 *  Hardware PEC                     yes
 | 
				
			||||||
 | 
					 *  Block buffer                     yes
 | 
				
			||||||
 | 
					 *  Block process call transaction   no
 | 
				
			||||||
 | 
					 *  Slave mode                       no
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include <linux/module.h>
 | 
				
			||||||
 | 
					#include <linux/init.h>
 | 
				
			||||||
 | 
					#include <linux/pci.h>
 | 
				
			||||||
 | 
					#include <linux/kernel.h>
 | 
				
			||||||
 | 
					#include <linux/stddef.h>
 | 
				
			||||||
 | 
					#include <linux/completion.h>
 | 
				
			||||||
 | 
					#include <linux/dma-mapping.h>
 | 
				
			||||||
 | 
					#include <linux/i2c.h>
 | 
				
			||||||
 | 
					#include <linux/acpi.h>
 | 
				
			||||||
 | 
					#include <linux/interrupt.h>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include <asm-generic/io-64-nonatomic-lo-hi.h>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* PCI Address Constants */
 | 
				
			||||||
 | 
					#define SMBBAR		0
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* PCI DIDs for the Intel SMBus Message Transport (SMT) Devices */
 | 
				
			||||||
 | 
					#define PCI_DEVICE_ID_INTEL_S1200_SMT0	0x0c59
 | 
				
			||||||
 | 
					#define PCI_DEVICE_ID_INTEL_S1200_SMT1	0x0c5a
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#define ISMT_DESC_ENTRIES	32	/* number of descriptor entries */
 | 
				
			||||||
 | 
					#define ISMT_MAX_RETRIES	3	/* number of SMBus retries to attempt */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* Hardware Descriptor Constants - Control Field */
 | 
				
			||||||
 | 
					#define ISMT_DESC_CWRL	0x01	/* Command/Write Length */
 | 
				
			||||||
 | 
					#define ISMT_DESC_BLK	0X04	/* Perform Block Transaction */
 | 
				
			||||||
 | 
					#define ISMT_DESC_FAIR	0x08	/* Set fairness flag upon successful arbit. */
 | 
				
			||||||
 | 
					#define ISMT_DESC_PEC	0x10	/* Packet Error Code */
 | 
				
			||||||
 | 
					#define ISMT_DESC_I2C	0x20	/* I2C Enable */
 | 
				
			||||||
 | 
					#define ISMT_DESC_INT	0x40	/* Interrupt */
 | 
				
			||||||
 | 
					#define ISMT_DESC_SOE	0x80	/* Stop On Error */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* Hardware Descriptor Constants - Status Field */
 | 
				
			||||||
 | 
					#define ISMT_DESC_SCS	0x01	/* Success */
 | 
				
			||||||
 | 
					#define ISMT_DESC_DLTO	0x04	/* Data Low Time Out */
 | 
				
			||||||
 | 
					#define ISMT_DESC_NAK	0x08	/* NAK Received */
 | 
				
			||||||
 | 
					#define ISMT_DESC_CRC	0x10	/* CRC Error */
 | 
				
			||||||
 | 
					#define ISMT_DESC_CLTO	0x20	/* Clock Low Time Out */
 | 
				
			||||||
 | 
					#define ISMT_DESC_COL	0x40	/* Collisions */
 | 
				
			||||||
 | 
					#define ISMT_DESC_LPR	0x80	/* Large Packet Received */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* Macros */
 | 
				
			||||||
 | 
					#define ISMT_DESC_ADDR_RW(addr, rw) (((addr) << 1) | (rw))
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* iSMT General Register address offsets (SMBBAR + <addr>) */
 | 
				
			||||||
 | 
					#define ISMT_GR_GCTRL		0x000	/* General Control */
 | 
				
			||||||
 | 
					#define ISMT_GR_SMTICL		0x008	/* SMT Interrupt Cause Location */
 | 
				
			||||||
 | 
					#define ISMT_GR_ERRINTMSK	0x010	/* Error Interrupt Mask */
 | 
				
			||||||
 | 
					#define ISMT_GR_ERRAERMSK	0x014	/* Error AER Mask */
 | 
				
			||||||
 | 
					#define ISMT_GR_ERRSTS		0x018	/* Error Status */
 | 
				
			||||||
 | 
					#define ISMT_GR_ERRINFO		0x01c	/* Error Information */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* iSMT Master Registers */
 | 
				
			||||||
 | 
					#define ISMT_MSTR_MDBA		0x100	/* Master Descriptor Base Address */
 | 
				
			||||||
 | 
					#define ISMT_MSTR_MCTRL		0x108	/* Master Control */
 | 
				
			||||||
 | 
					#define ISMT_MSTR_MSTS		0x10c	/* Master Status */
 | 
				
			||||||
 | 
					#define ISMT_MSTR_MDS		0x110	/* Master Descriptor Size */
 | 
				
			||||||
 | 
					#define ISMT_MSTR_RPOLICY	0x114	/* Retry Policy */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* iSMT Miscellaneous Registers */
 | 
				
			||||||
 | 
					#define ISMT_SPGT	0x300	/* SMBus PHY Global Timing */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* General Control Register (GCTRL) bit definitions */
 | 
				
			||||||
 | 
					#define ISMT_GCTRL_TRST	0x04	/* Target Reset */
 | 
				
			||||||
 | 
					#define ISMT_GCTRL_KILL	0x08	/* Kill */
 | 
				
			||||||
 | 
					#define ISMT_GCTRL_SRST	0x40	/* Soft Reset */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* Master Control Register (MCTRL) bit definitions */
 | 
				
			||||||
 | 
					#define ISMT_MCTRL_SS	0x01		/* Start/Stop */
 | 
				
			||||||
 | 
					#define ISMT_MCTRL_MEIE	0x10		/* Master Error Interrupt Enable */
 | 
				
			||||||
 | 
					#define ISMT_MCTRL_FMHP	0x00ff0000	/* Firmware Master Head Ptr (FMHP) */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* Master Status Register (MSTS) bit definitions */
 | 
				
			||||||
 | 
					#define ISMT_MSTS_HMTP	0xff0000	/* HW Master Tail Pointer (HMTP) */
 | 
				
			||||||
 | 
					#define ISMT_MSTS_MIS	0x20		/* Master Interrupt Status (MIS) */
 | 
				
			||||||
 | 
					#define ISMT_MSTS_MEIS	0x10		/* Master Error Int Status (MEIS) */
 | 
				
			||||||
 | 
					#define ISMT_MSTS_IP	0x01		/* In Progress */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* Master Descriptor Size (MDS) bit definitions */
 | 
				
			||||||
 | 
					#define ISMT_MDS_MASK	0xff	/* Master Descriptor Size mask (MDS) */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* SMBus PHY Global Timing Register (SPGT) bit definitions */
 | 
				
			||||||
 | 
					#define ISMT_SPGT_SPD_MASK	0xc0000000	/* SMBus Speed mask */
 | 
				
			||||||
 | 
					#define ISMT_SPGT_SPD_80K	0x00		/* 80 kHz */
 | 
				
			||||||
 | 
					#define ISMT_SPGT_SPD_100K	(0x1 << 30)	/* 100 kHz */
 | 
				
			||||||
 | 
					#define ISMT_SPGT_SPD_400K	(0x2 << 30)	/* 400 kHz */
 | 
				
			||||||
 | 
					#define ISMT_SPGT_SPD_1M	(0x3 << 30)	/* 1 MHz */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* MSI Control Register (MSICTL) bit definitions */
 | 
				
			||||||
 | 
					#define ISMT_MSICTL_MSIE	0x01	/* MSI Enable */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* iSMT Hardware Descriptor */
 | 
				
			||||||
 | 
					struct ismt_desc {
 | 
				
			||||||
 | 
						u8 tgtaddr_rw;	/* target address & r/w bit */
 | 
				
			||||||
 | 
						u8 wr_len_cmd;	/* write length in bytes or a command */
 | 
				
			||||||
 | 
						u8 rd_len;	/* read length */
 | 
				
			||||||
 | 
						u8 control;	/* control bits */
 | 
				
			||||||
 | 
						u8 status;	/* status bits */
 | 
				
			||||||
 | 
						u8 retry;	/* collision retry and retry count */
 | 
				
			||||||
 | 
						u8 rxbytes;	/* received bytes */
 | 
				
			||||||
 | 
						u8 txbytes;	/* transmitted bytes */
 | 
				
			||||||
 | 
						u32 dptr_low;	/* lower 32 bit of the data pointer */
 | 
				
			||||||
 | 
						u32 dptr_high;	/* upper 32 bit of the data pointer */
 | 
				
			||||||
 | 
					} __packed;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					struct ismt_priv {
 | 
				
			||||||
 | 
						struct i2c_adapter adapter;
 | 
				
			||||||
 | 
						void *smba;				/* PCI BAR */
 | 
				
			||||||
 | 
						struct pci_dev *pci_dev;
 | 
				
			||||||
 | 
						struct ismt_desc *hw;			/* descriptor virt base addr */
 | 
				
			||||||
 | 
						dma_addr_t io_rng_dma;			/* descriptor HW base addr */
 | 
				
			||||||
 | 
						u8 head;				/* ring buffer head pointer */
 | 
				
			||||||
 | 
						struct completion cmp;			/* interrupt completion */
 | 
				
			||||||
 | 
						u8 dma_buffer[I2C_SMBUS_BLOCK_MAX + 1];	/* temp R/W data buffer */
 | 
				
			||||||
 | 
						bool using_msi;				/* type of interrupt flag */
 | 
				
			||||||
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_ids - PCI device IDs supported by this driver
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static const DEFINE_PCI_DEVICE_TABLE(ismt_ids) = {
 | 
				
			||||||
 | 
						{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_S1200_SMT0) },
 | 
				
			||||||
 | 
						{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_S1200_SMT1) },
 | 
				
			||||||
 | 
						{ 0, }
 | 
				
			||||||
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					MODULE_DEVICE_TABLE(pci, ismt_ids);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* Bus speed control bits for slow debuggers - refer to the docs for usage */
 | 
				
			||||||
 | 
					static unsigned int bus_speed;
 | 
				
			||||||
 | 
					module_param(bus_speed, uint, S_IRUGO);
 | 
				
			||||||
 | 
					MODULE_PARM_DESC(bus_speed, "Bus Speed in kHz (0 = BIOS default)");
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * __ismt_desc_dump() - dump the contents of a specific descriptor
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static void __ismt_desc_dump(struct device *dev, const struct ismt_desc *desc)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						dev_dbg(dev, "Descriptor struct:  %p\n", desc);
 | 
				
			||||||
 | 
						dev_dbg(dev, "\ttgtaddr_rw=0x%02X\n", desc->tgtaddr_rw);
 | 
				
			||||||
 | 
						dev_dbg(dev, "\twr_len_cmd=0x%02X\n", desc->wr_len_cmd);
 | 
				
			||||||
 | 
						dev_dbg(dev, "\trd_len=    0x%02X\n", desc->rd_len);
 | 
				
			||||||
 | 
						dev_dbg(dev, "\tcontrol=   0x%02X\n", desc->control);
 | 
				
			||||||
 | 
						dev_dbg(dev, "\tstatus=    0x%02X\n", desc->status);
 | 
				
			||||||
 | 
						dev_dbg(dev, "\tretry=     0x%02X\n", desc->retry);
 | 
				
			||||||
 | 
						dev_dbg(dev, "\trxbytes=   0x%02X\n", desc->rxbytes);
 | 
				
			||||||
 | 
						dev_dbg(dev, "\ttxbytes=   0x%02X\n", desc->txbytes);
 | 
				
			||||||
 | 
						dev_dbg(dev, "\tdptr_low=  0x%08X\n", desc->dptr_low);
 | 
				
			||||||
 | 
						dev_dbg(dev, "\tdptr_high= 0x%08X\n", desc->dptr_high);
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_desc_dump() - dump the contents of a descriptor for debug purposes
 | 
				
			||||||
 | 
					 * @priv: iSMT private data
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static void ismt_desc_dump(struct ismt_priv *priv)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						struct device *dev = &priv->pci_dev->dev;
 | 
				
			||||||
 | 
						struct ismt_desc *desc = &priv->hw[priv->head];
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						dev_dbg(dev, "Dump of the descriptor struct:  0x%X\n", priv->head);
 | 
				
			||||||
 | 
						__ismt_desc_dump(dev, desc);
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_gen_reg_dump() - dump the iSMT General Registers
 | 
				
			||||||
 | 
					 * @priv: iSMT private data
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static void ismt_gen_reg_dump(struct ismt_priv *priv)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						struct device *dev = &priv->pci_dev->dev;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						dev_dbg(dev, "Dump of the iSMT General Registers\n");
 | 
				
			||||||
 | 
						dev_dbg(dev, "  GCTRL.... : (0x%p)=0x%X\n",
 | 
				
			||||||
 | 
							priv->smba + ISMT_GR_GCTRL,
 | 
				
			||||||
 | 
							readl(priv->smba + ISMT_GR_GCTRL));
 | 
				
			||||||
 | 
						dev_dbg(dev, "  SMTICL... : (0x%p)=0x%016llX\n",
 | 
				
			||||||
 | 
							priv->smba + ISMT_GR_SMTICL,
 | 
				
			||||||
 | 
							(long long unsigned int)readq(priv->smba + ISMT_GR_SMTICL));
 | 
				
			||||||
 | 
						dev_dbg(dev, "  ERRINTMSK : (0x%p)=0x%X\n",
 | 
				
			||||||
 | 
							priv->smba + ISMT_GR_ERRINTMSK,
 | 
				
			||||||
 | 
							readl(priv->smba + ISMT_GR_ERRINTMSK));
 | 
				
			||||||
 | 
						dev_dbg(dev, "  ERRAERMSK : (0x%p)=0x%X\n",
 | 
				
			||||||
 | 
							priv->smba + ISMT_GR_ERRAERMSK,
 | 
				
			||||||
 | 
							readl(priv->smba + ISMT_GR_ERRAERMSK));
 | 
				
			||||||
 | 
						dev_dbg(dev, "  ERRSTS... : (0x%p)=0x%X\n",
 | 
				
			||||||
 | 
							priv->smba + ISMT_GR_ERRSTS,
 | 
				
			||||||
 | 
							readl(priv->smba + ISMT_GR_ERRSTS));
 | 
				
			||||||
 | 
						dev_dbg(dev, "  ERRINFO.. : (0x%p)=0x%X\n",
 | 
				
			||||||
 | 
							priv->smba + ISMT_GR_ERRINFO,
 | 
				
			||||||
 | 
							readl(priv->smba + ISMT_GR_ERRINFO));
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_mstr_reg_dump() - dump the iSMT Master Registers
 | 
				
			||||||
 | 
					 * @priv: iSMT private data
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static void ismt_mstr_reg_dump(struct ismt_priv *priv)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						struct device *dev = &priv->pci_dev->dev;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						dev_dbg(dev, "Dump of the iSMT Master Registers\n");
 | 
				
			||||||
 | 
						dev_dbg(dev, "  MDBA..... : (0x%p)=0x%016llX\n",
 | 
				
			||||||
 | 
							priv->smba + ISMT_MSTR_MDBA,
 | 
				
			||||||
 | 
							(long long unsigned int)readq(priv->smba + ISMT_MSTR_MDBA));
 | 
				
			||||||
 | 
						dev_dbg(dev, "  MCTRL.... : (0x%p)=0x%X\n",
 | 
				
			||||||
 | 
							priv->smba + ISMT_MSTR_MCTRL,
 | 
				
			||||||
 | 
							readl(priv->smba + ISMT_MSTR_MCTRL));
 | 
				
			||||||
 | 
						dev_dbg(dev, "  MSTS..... : (0x%p)=0x%X\n",
 | 
				
			||||||
 | 
							priv->smba + ISMT_MSTR_MSTS,
 | 
				
			||||||
 | 
							readl(priv->smba + ISMT_MSTR_MSTS));
 | 
				
			||||||
 | 
						dev_dbg(dev, "  MDS...... : (0x%p)=0x%X\n",
 | 
				
			||||||
 | 
							priv->smba + ISMT_MSTR_MDS,
 | 
				
			||||||
 | 
							readl(priv->smba + ISMT_MSTR_MDS));
 | 
				
			||||||
 | 
						dev_dbg(dev, "  RPOLICY.. : (0x%p)=0x%X\n",
 | 
				
			||||||
 | 
							priv->smba + ISMT_MSTR_RPOLICY,
 | 
				
			||||||
 | 
							readl(priv->smba + ISMT_MSTR_RPOLICY));
 | 
				
			||||||
 | 
						dev_dbg(dev, "  SPGT..... : (0x%p)=0x%X\n",
 | 
				
			||||||
 | 
							priv->smba + ISMT_SPGT,
 | 
				
			||||||
 | 
							readl(priv->smba + ISMT_SPGT));
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_submit_desc() - add a descriptor to the ring
 | 
				
			||||||
 | 
					 * @priv: iSMT private data
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static void ismt_submit_desc(struct ismt_priv *priv)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						uint fmhp;
 | 
				
			||||||
 | 
						uint val;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						ismt_desc_dump(priv);
 | 
				
			||||||
 | 
						ismt_gen_reg_dump(priv);
 | 
				
			||||||
 | 
						ismt_mstr_reg_dump(priv);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* Set the FMHP (Firmware Master Head Pointer)*/
 | 
				
			||||||
 | 
						fmhp = ((priv->head + 1) % ISMT_DESC_ENTRIES) << 16;
 | 
				
			||||||
 | 
						val = readl(priv->smba + ISMT_MSTR_MCTRL);
 | 
				
			||||||
 | 
						writel((val & ~ISMT_MCTRL_FMHP) | fmhp,
 | 
				
			||||||
 | 
						       priv->smba + ISMT_MSTR_MCTRL);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* Set the start bit */
 | 
				
			||||||
 | 
						val = readl(priv->smba + ISMT_MSTR_MCTRL);
 | 
				
			||||||
 | 
						writel(val | ISMT_MCTRL_SS,
 | 
				
			||||||
 | 
						       priv->smba + ISMT_MSTR_MCTRL);
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_process_desc() - handle the completion of the descriptor
 | 
				
			||||||
 | 
					 * @desc: the iSMT hardware descriptor
 | 
				
			||||||
 | 
					 * @data: data buffer from the upper layer
 | 
				
			||||||
 | 
					 * @priv: ismt_priv struct holding our dma buffer
 | 
				
			||||||
 | 
					 * @size: SMBus transaction type
 | 
				
			||||||
 | 
					 * @read_write: flag to indicate if this is a read or write
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static int ismt_process_desc(const struct ismt_desc *desc,
 | 
				
			||||||
 | 
								     union i2c_smbus_data *data,
 | 
				
			||||||
 | 
								     struct ismt_priv *priv, int size,
 | 
				
			||||||
 | 
								     char read_write)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						u8 *dma_buffer = priv->dma_buffer;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						dev_dbg(&priv->pci_dev->dev, "Processing completed descriptor\n");
 | 
				
			||||||
 | 
						__ismt_desc_dump(&priv->pci_dev->dev, desc);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						if (desc->status & ISMT_DESC_SCS) {
 | 
				
			||||||
 | 
							if (read_write == I2C_SMBUS_WRITE &&
 | 
				
			||||||
 | 
							    size != I2C_SMBUS_PROC_CALL)
 | 
				
			||||||
 | 
								return 0;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
							switch (size) {
 | 
				
			||||||
 | 
							case I2C_SMBUS_BYTE:
 | 
				
			||||||
 | 
							case I2C_SMBUS_BYTE_DATA:
 | 
				
			||||||
 | 
								data->byte = dma_buffer[0];
 | 
				
			||||||
 | 
								break;
 | 
				
			||||||
 | 
							case I2C_SMBUS_WORD_DATA:
 | 
				
			||||||
 | 
							case I2C_SMBUS_PROC_CALL:
 | 
				
			||||||
 | 
								data->word = dma_buffer[0] | (dma_buffer[1] << 8);
 | 
				
			||||||
 | 
								break;
 | 
				
			||||||
 | 
							case I2C_SMBUS_BLOCK_DATA:
 | 
				
			||||||
 | 
								memcpy(&data->block[1], dma_buffer, desc->rxbytes);
 | 
				
			||||||
 | 
								data->block[0] = desc->rxbytes;
 | 
				
			||||||
 | 
								break;
 | 
				
			||||||
 | 
							}
 | 
				
			||||||
 | 
							return 0;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						if (likely(desc->status & ISMT_DESC_NAK))
 | 
				
			||||||
 | 
							return -ENXIO;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						if (desc->status & ISMT_DESC_CRC)
 | 
				
			||||||
 | 
							return -EBADMSG;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						if (desc->status & ISMT_DESC_COL)
 | 
				
			||||||
 | 
							return -EAGAIN;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						if (desc->status & ISMT_DESC_LPR)
 | 
				
			||||||
 | 
							return -EPROTO;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						if (desc->status & (ISMT_DESC_DLTO | ISMT_DESC_CLTO))
 | 
				
			||||||
 | 
							return -ETIMEDOUT;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						return -EIO;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_access() - process an SMBus command
 | 
				
			||||||
 | 
					 * @adap: the i2c host adapter
 | 
				
			||||||
 | 
					 * @addr: address of the i2c/SMBus target
 | 
				
			||||||
 | 
					 * @flags: command options
 | 
				
			||||||
 | 
					 * @read_write: read from or write to device
 | 
				
			||||||
 | 
					 * @command: the i2c/SMBus command to issue
 | 
				
			||||||
 | 
					 * @size: SMBus transaction type
 | 
				
			||||||
 | 
					 * @data: read/write data buffer
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static int ismt_access(struct i2c_adapter *adap, u16 addr,
 | 
				
			||||||
 | 
							       unsigned short flags, char read_write, u8 command,
 | 
				
			||||||
 | 
							       int size, union i2c_smbus_data *data)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						int ret;
 | 
				
			||||||
 | 
						dma_addr_t dma_addr = 0; /* address of the data buffer */
 | 
				
			||||||
 | 
						u8 dma_size = 0;
 | 
				
			||||||
 | 
						enum dma_data_direction dma_direction = 0;
 | 
				
			||||||
 | 
						struct ismt_desc *desc;
 | 
				
			||||||
 | 
						struct ismt_priv *priv = i2c_get_adapdata(adap);
 | 
				
			||||||
 | 
						struct device *dev = &priv->pci_dev->dev;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						desc = &priv->hw[priv->head];
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* Initialize the descriptor */
 | 
				
			||||||
 | 
						memset(desc, 0, sizeof(struct ismt_desc));
 | 
				
			||||||
 | 
						desc->tgtaddr_rw = ISMT_DESC_ADDR_RW(addr, read_write);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* Initialize common control bits */
 | 
				
			||||||
 | 
						if (likely(priv->using_msi))
 | 
				
			||||||
 | 
							desc->control = ISMT_DESC_INT | ISMT_DESC_FAIR;
 | 
				
			||||||
 | 
						else
 | 
				
			||||||
 | 
							desc->control = ISMT_DESC_FAIR;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						if ((flags & I2C_CLIENT_PEC) && (size != I2C_SMBUS_QUICK)
 | 
				
			||||||
 | 
						    && (size != I2C_SMBUS_I2C_BLOCK_DATA))
 | 
				
			||||||
 | 
							desc->control |= ISMT_DESC_PEC;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						switch (size) {
 | 
				
			||||||
 | 
						case I2C_SMBUS_QUICK:
 | 
				
			||||||
 | 
							dev_dbg(dev, "I2C_SMBUS_QUICK\n");
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						case I2C_SMBUS_BYTE:
 | 
				
			||||||
 | 
							if (read_write == I2C_SMBUS_WRITE) {
 | 
				
			||||||
 | 
								/*
 | 
				
			||||||
 | 
								 * Send Byte
 | 
				
			||||||
 | 
								 * The command field contains the write data
 | 
				
			||||||
 | 
								 */
 | 
				
			||||||
 | 
								dev_dbg(dev, "I2C_SMBUS_BYTE:  WRITE\n");
 | 
				
			||||||
 | 
								desc->control |= ISMT_DESC_CWRL;
 | 
				
			||||||
 | 
								desc->wr_len_cmd = command;
 | 
				
			||||||
 | 
							} else {
 | 
				
			||||||
 | 
								/* Receive Byte */
 | 
				
			||||||
 | 
								dev_dbg(dev, "I2C_SMBUS_BYTE:  READ\n");
 | 
				
			||||||
 | 
								dma_size = 1;
 | 
				
			||||||
 | 
								dma_direction = DMA_FROM_DEVICE;
 | 
				
			||||||
 | 
								desc->rd_len = 1;
 | 
				
			||||||
 | 
							}
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						case I2C_SMBUS_BYTE_DATA:
 | 
				
			||||||
 | 
							if (read_write == I2C_SMBUS_WRITE) {
 | 
				
			||||||
 | 
								/*
 | 
				
			||||||
 | 
								 * Write Byte
 | 
				
			||||||
 | 
								 * Command plus 1 data byte
 | 
				
			||||||
 | 
								 */
 | 
				
			||||||
 | 
								dev_dbg(dev, "I2C_SMBUS_BYTE_DATA:  WRITE\n");
 | 
				
			||||||
 | 
								desc->wr_len_cmd = 2;
 | 
				
			||||||
 | 
								dma_size = 2;
 | 
				
			||||||
 | 
								dma_direction = DMA_TO_DEVICE;
 | 
				
			||||||
 | 
								priv->dma_buffer[0] = command;
 | 
				
			||||||
 | 
								priv->dma_buffer[1] = data->byte;
 | 
				
			||||||
 | 
							} else {
 | 
				
			||||||
 | 
								/* Read Byte */
 | 
				
			||||||
 | 
								dev_dbg(dev, "I2C_SMBUS_BYTE_DATA:  READ\n");
 | 
				
			||||||
 | 
								desc->control |= ISMT_DESC_CWRL;
 | 
				
			||||||
 | 
								desc->wr_len_cmd = command;
 | 
				
			||||||
 | 
								desc->rd_len = 1;
 | 
				
			||||||
 | 
								dma_size = 1;
 | 
				
			||||||
 | 
								dma_direction = DMA_FROM_DEVICE;
 | 
				
			||||||
 | 
							}
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						case I2C_SMBUS_WORD_DATA:
 | 
				
			||||||
 | 
							if (read_write == I2C_SMBUS_WRITE) {
 | 
				
			||||||
 | 
								/* Write Word */
 | 
				
			||||||
 | 
								dev_dbg(dev, "I2C_SMBUS_WORD_DATA:  WRITE\n");
 | 
				
			||||||
 | 
								desc->wr_len_cmd = 3;
 | 
				
			||||||
 | 
								dma_size = 3;
 | 
				
			||||||
 | 
								dma_direction = DMA_TO_DEVICE;
 | 
				
			||||||
 | 
								priv->dma_buffer[0] = command;
 | 
				
			||||||
 | 
								priv->dma_buffer[1] = data->word & 0xff;
 | 
				
			||||||
 | 
								priv->dma_buffer[2] = data->word >> 8;
 | 
				
			||||||
 | 
							} else {
 | 
				
			||||||
 | 
								/* Read Word */
 | 
				
			||||||
 | 
								dev_dbg(dev, "I2C_SMBUS_WORD_DATA:  READ\n");
 | 
				
			||||||
 | 
								desc->wr_len_cmd = command;
 | 
				
			||||||
 | 
								desc->control |= ISMT_DESC_CWRL;
 | 
				
			||||||
 | 
								desc->rd_len = 2;
 | 
				
			||||||
 | 
								dma_size = 2;
 | 
				
			||||||
 | 
								dma_direction = DMA_FROM_DEVICE;
 | 
				
			||||||
 | 
							}
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						case I2C_SMBUS_PROC_CALL:
 | 
				
			||||||
 | 
							dev_dbg(dev, "I2C_SMBUS_PROC_CALL\n");
 | 
				
			||||||
 | 
							desc->wr_len_cmd = 3;
 | 
				
			||||||
 | 
							desc->rd_len = 2;
 | 
				
			||||||
 | 
							dma_size = 3;
 | 
				
			||||||
 | 
							dma_direction = DMA_BIDIRECTIONAL;
 | 
				
			||||||
 | 
							priv->dma_buffer[0] = command;
 | 
				
			||||||
 | 
							priv->dma_buffer[1] = data->word & 0xff;
 | 
				
			||||||
 | 
							priv->dma_buffer[2] = data->word >> 8;
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						case I2C_SMBUS_BLOCK_DATA:
 | 
				
			||||||
 | 
							if (read_write == I2C_SMBUS_WRITE) {
 | 
				
			||||||
 | 
								/* Block Write */
 | 
				
			||||||
 | 
								dev_dbg(dev, "I2C_SMBUS_BLOCK_DATA:  WRITE\n");
 | 
				
			||||||
 | 
								dma_size = data->block[0] + 1;
 | 
				
			||||||
 | 
								dma_direction = DMA_TO_DEVICE;
 | 
				
			||||||
 | 
								desc->wr_len_cmd = dma_size;
 | 
				
			||||||
 | 
								desc->control |= ISMT_DESC_BLK;
 | 
				
			||||||
 | 
								priv->dma_buffer[0] = command;
 | 
				
			||||||
 | 
								memcpy(&priv->dma_buffer[1], &data->block[1], dma_size);
 | 
				
			||||||
 | 
							} else {
 | 
				
			||||||
 | 
								/* Block Read */
 | 
				
			||||||
 | 
								dev_dbg(dev, "I2C_SMBUS_BLOCK_DATA:  READ\n");
 | 
				
			||||||
 | 
								dma_size = I2C_SMBUS_BLOCK_MAX;
 | 
				
			||||||
 | 
								dma_direction = DMA_FROM_DEVICE;
 | 
				
			||||||
 | 
								desc->rd_len = dma_size;
 | 
				
			||||||
 | 
								desc->wr_len_cmd = command;
 | 
				
			||||||
 | 
								desc->control |= (ISMT_DESC_BLK | ISMT_DESC_CWRL);
 | 
				
			||||||
 | 
							}
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						default:
 | 
				
			||||||
 | 
							dev_err(dev, "Unsupported transaction %d\n",
 | 
				
			||||||
 | 
								size);
 | 
				
			||||||
 | 
							return -EOPNOTSUPP;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* map the data buffer */
 | 
				
			||||||
 | 
						if (dma_size != 0) {
 | 
				
			||||||
 | 
							dev_dbg(dev, " dev=%p\n", dev);
 | 
				
			||||||
 | 
							dev_dbg(dev, " data=%p\n", data);
 | 
				
			||||||
 | 
							dev_dbg(dev, " dma_buffer=%p\n", priv->dma_buffer);
 | 
				
			||||||
 | 
							dev_dbg(dev, " dma_size=%d\n", dma_size);
 | 
				
			||||||
 | 
							dev_dbg(dev, " dma_direction=%d\n", dma_direction);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
							dma_addr = dma_map_single(dev,
 | 
				
			||||||
 | 
									      priv->dma_buffer,
 | 
				
			||||||
 | 
									      dma_size,
 | 
				
			||||||
 | 
									      dma_direction);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
							if (dma_mapping_error(dev, dma_addr)) {
 | 
				
			||||||
 | 
								dev_err(dev, "Error in mapping dma buffer %p\n",
 | 
				
			||||||
 | 
									priv->dma_buffer);
 | 
				
			||||||
 | 
								return -EIO;
 | 
				
			||||||
 | 
							}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
							dev_dbg(dev, " dma_addr = 0x%016llX\n",
 | 
				
			||||||
 | 
								dma_addr);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
							desc->dptr_low = lower_32_bits(dma_addr);
 | 
				
			||||||
 | 
							desc->dptr_high = upper_32_bits(dma_addr);
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						INIT_COMPLETION(priv->cmp);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* Add the descriptor */
 | 
				
			||||||
 | 
						ismt_submit_desc(priv);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* Now we wait for interrupt completion, 1s */
 | 
				
			||||||
 | 
						ret = wait_for_completion_timeout(&priv->cmp, HZ*1);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* unmap the data buffer */
 | 
				
			||||||
 | 
						if (dma_size != 0)
 | 
				
			||||||
 | 
							dma_unmap_single(&adap->dev, dma_addr, dma_size, dma_direction);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						if (unlikely(!ret)) {
 | 
				
			||||||
 | 
							dev_err(dev, "completion wait timed out\n");
 | 
				
			||||||
 | 
							ret = -ETIMEDOUT;
 | 
				
			||||||
 | 
							goto out;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* do any post processing of the descriptor here */
 | 
				
			||||||
 | 
						ret = ismt_process_desc(desc, data, priv, size, read_write);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					out:
 | 
				
			||||||
 | 
						/* Update the ring pointer */
 | 
				
			||||||
 | 
						priv->head++;
 | 
				
			||||||
 | 
						priv->head %= ISMT_DESC_ENTRIES;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						return ret;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_func() - report which i2c commands are supported by this adapter
 | 
				
			||||||
 | 
					 * @adap: the i2c host adapter
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static u32 ismt_func(struct i2c_adapter *adap)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						return I2C_FUNC_SMBUS_QUICK		|
 | 
				
			||||||
 | 
						       I2C_FUNC_SMBUS_BYTE		|
 | 
				
			||||||
 | 
						       I2C_FUNC_SMBUS_BYTE_DATA		|
 | 
				
			||||||
 | 
						       I2C_FUNC_SMBUS_WORD_DATA		|
 | 
				
			||||||
 | 
						       I2C_FUNC_SMBUS_PROC_CALL		|
 | 
				
			||||||
 | 
						       I2C_FUNC_SMBUS_BLOCK_DATA	|
 | 
				
			||||||
 | 
						       I2C_FUNC_SMBUS_PEC;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * smbus_algorithm - the adapter algorithm and supported functionality
 | 
				
			||||||
 | 
					 * @smbus_xfer: the adapter algorithm
 | 
				
			||||||
 | 
					 * @functionality: functionality supported by the adapter
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static const struct i2c_algorithm smbus_algorithm = {
 | 
				
			||||||
 | 
						.smbus_xfer	= ismt_access,
 | 
				
			||||||
 | 
						.functionality	= ismt_func,
 | 
				
			||||||
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_handle_isr() - interrupt handler bottom half
 | 
				
			||||||
 | 
					 * @priv: iSMT private data
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static irqreturn_t ismt_handle_isr(struct ismt_priv *priv)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						complete(&priv->cmp);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						return IRQ_HANDLED;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_do_interrupt() - IRQ interrupt handler
 | 
				
			||||||
 | 
					 * @vec: interrupt vector
 | 
				
			||||||
 | 
					 * @data: iSMT private data
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static irqreturn_t ismt_do_interrupt(int vec, void *data)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						u32 val;
 | 
				
			||||||
 | 
						struct ismt_priv *priv = data;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/*
 | 
				
			||||||
 | 
						 * check to see it's our interrupt, return IRQ_NONE if not ours
 | 
				
			||||||
 | 
						 * since we are sharing interrupt
 | 
				
			||||||
 | 
						 */
 | 
				
			||||||
 | 
						val = readl(priv->smba + ISMT_MSTR_MSTS);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						if (!(val & (ISMT_MSTS_MIS | ISMT_MSTS_MEIS)))
 | 
				
			||||||
 | 
							return IRQ_NONE;
 | 
				
			||||||
 | 
						else
 | 
				
			||||||
 | 
							writel(val | ISMT_MSTS_MIS | ISMT_MSTS_MEIS,
 | 
				
			||||||
 | 
							       priv->smba + ISMT_MSTR_MSTS);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						return ismt_handle_isr(priv);
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_do_msi_interrupt() - MSI interrupt handler
 | 
				
			||||||
 | 
					 * @vec: interrupt vector
 | 
				
			||||||
 | 
					 * @data: iSMT private data
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static irqreturn_t ismt_do_msi_interrupt(int vec, void *data)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						return ismt_handle_isr(data);
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_hw_init() - initialize the iSMT hardware
 | 
				
			||||||
 | 
					 * @priv: iSMT private data
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static void ismt_hw_init(struct ismt_priv *priv)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						u32 val;
 | 
				
			||||||
 | 
						struct device *dev = &priv->pci_dev->dev;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* initialize the Master Descriptor Base Address (MDBA) */
 | 
				
			||||||
 | 
						writeq(priv->io_rng_dma, priv->smba + ISMT_MSTR_MDBA);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* initialize the Master Control Register (MCTRL) */
 | 
				
			||||||
 | 
						writel(ISMT_MCTRL_MEIE, priv->smba + ISMT_MSTR_MCTRL);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* initialize the Master Status Register (MSTS) */
 | 
				
			||||||
 | 
						writel(0, priv->smba + ISMT_MSTR_MSTS);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* initialize the Master Descriptor Size (MDS) */
 | 
				
			||||||
 | 
						val = readl(priv->smba + ISMT_MSTR_MDS);
 | 
				
			||||||
 | 
						writel((val & ~ISMT_MDS_MASK) | (ISMT_DESC_ENTRIES - 1),
 | 
				
			||||||
 | 
							priv->smba + ISMT_MSTR_MDS);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/*
 | 
				
			||||||
 | 
						 * Set the SMBus speed (could use this for slow HW debuggers)
 | 
				
			||||||
 | 
						 */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						val = readl(priv->smba + ISMT_SPGT);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						switch (bus_speed) {
 | 
				
			||||||
 | 
						case 0:
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						case 80:
 | 
				
			||||||
 | 
							dev_dbg(dev, "Setting SMBus clock to 80 kHz\n");
 | 
				
			||||||
 | 
							writel(((val & ~ISMT_SPGT_SPD_MASK) | ISMT_SPGT_SPD_80K),
 | 
				
			||||||
 | 
								priv->smba + ISMT_SPGT);
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						case 100:
 | 
				
			||||||
 | 
							dev_dbg(dev, "Setting SMBus clock to 100 kHz\n");
 | 
				
			||||||
 | 
							writel(((val & ~ISMT_SPGT_SPD_MASK) | ISMT_SPGT_SPD_100K),
 | 
				
			||||||
 | 
								priv->smba + ISMT_SPGT);
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						case 400:
 | 
				
			||||||
 | 
							dev_dbg(dev, "Setting SMBus clock to 400 kHz\n");
 | 
				
			||||||
 | 
							writel(((val & ~ISMT_SPGT_SPD_MASK) | ISMT_SPGT_SPD_400K),
 | 
				
			||||||
 | 
								priv->smba + ISMT_SPGT);
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						case 1000:
 | 
				
			||||||
 | 
							dev_dbg(dev, "Setting SMBus clock to 1000 kHz\n");
 | 
				
			||||||
 | 
							writel(((val & ~ISMT_SPGT_SPD_MASK) | ISMT_SPGT_SPD_1M),
 | 
				
			||||||
 | 
								priv->smba + ISMT_SPGT);
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						default:
 | 
				
			||||||
 | 
							dev_warn(dev, "Invalid SMBus clock speed, only 0, 80, 100, 400, and 1000 are valid\n");
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						val = readl(priv->smba + ISMT_SPGT);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						switch (val & ISMT_SPGT_SPD_MASK) {
 | 
				
			||||||
 | 
						case ISMT_SPGT_SPD_80K:
 | 
				
			||||||
 | 
							bus_speed = 80;
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
						case ISMT_SPGT_SPD_100K:
 | 
				
			||||||
 | 
							bus_speed = 100;
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
						case ISMT_SPGT_SPD_400K:
 | 
				
			||||||
 | 
							bus_speed = 400;
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
						case ISMT_SPGT_SPD_1M:
 | 
				
			||||||
 | 
							bus_speed = 1000;
 | 
				
			||||||
 | 
							break;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
						dev_dbg(dev, "SMBus clock is running at %d kHz\n", bus_speed);
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_dev_init() - initialize the iSMT data structures
 | 
				
			||||||
 | 
					 * @priv: iSMT private data
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static int ismt_dev_init(struct ismt_priv *priv)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						/* allocate memory for the descriptor */
 | 
				
			||||||
 | 
						priv->hw = dmam_alloc_coherent(&priv->pci_dev->dev,
 | 
				
			||||||
 | 
									       (ISMT_DESC_ENTRIES
 | 
				
			||||||
 | 
										       * sizeof(struct ismt_desc)),
 | 
				
			||||||
 | 
									       &priv->io_rng_dma,
 | 
				
			||||||
 | 
									       GFP_KERNEL);
 | 
				
			||||||
 | 
						if (!priv->hw)
 | 
				
			||||||
 | 
							return -ENOMEM;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						memset(priv->hw, 0, (ISMT_DESC_ENTRIES * sizeof(struct ismt_desc)));
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						priv->head = 0;
 | 
				
			||||||
 | 
						init_completion(&priv->cmp);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						return 0;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_int_init() - initialize interrupts
 | 
				
			||||||
 | 
					 * @priv: iSMT private data
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static int ismt_int_init(struct ismt_priv *priv)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						int err;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* Try using MSI interrupts */
 | 
				
			||||||
 | 
						err = pci_enable_msi(priv->pci_dev);
 | 
				
			||||||
 | 
						if (err) {
 | 
				
			||||||
 | 
							dev_warn(&priv->pci_dev->dev,
 | 
				
			||||||
 | 
								 "Unable to use MSI interrupts, falling back to legacy\n");
 | 
				
			||||||
 | 
							goto intx;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						err = devm_request_irq(&priv->pci_dev->dev,
 | 
				
			||||||
 | 
								       priv->pci_dev->irq,
 | 
				
			||||||
 | 
								       ismt_do_msi_interrupt,
 | 
				
			||||||
 | 
								       0,
 | 
				
			||||||
 | 
								       "ismt-msi",
 | 
				
			||||||
 | 
								       priv);
 | 
				
			||||||
 | 
						if (err) {
 | 
				
			||||||
 | 
							pci_disable_msi(priv->pci_dev);
 | 
				
			||||||
 | 
							goto intx;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						priv->using_msi = true;
 | 
				
			||||||
 | 
						goto done;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* Try using legacy interrupts */
 | 
				
			||||||
 | 
					intx:
 | 
				
			||||||
 | 
						err = devm_request_irq(&priv->pci_dev->dev,
 | 
				
			||||||
 | 
								       priv->pci_dev->irq,
 | 
				
			||||||
 | 
								       ismt_do_interrupt,
 | 
				
			||||||
 | 
								       IRQF_SHARED,
 | 
				
			||||||
 | 
								       "ismt-intx",
 | 
				
			||||||
 | 
								       priv);
 | 
				
			||||||
 | 
						if (err) {
 | 
				
			||||||
 | 
							dev_err(&priv->pci_dev->dev, "no usable interrupts\n");
 | 
				
			||||||
 | 
							return -ENODEV;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						priv->using_msi = false;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					done:
 | 
				
			||||||
 | 
						return 0;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					static struct pci_driver ismt_driver;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_probe() - probe for iSMT devices
 | 
				
			||||||
 | 
					 * @pdev: PCI-Express device
 | 
				
			||||||
 | 
					 * @id: PCI-Express device ID
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static int
 | 
				
			||||||
 | 
					ismt_probe(struct pci_dev *pdev, const struct pci_device_id *id)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						int err;
 | 
				
			||||||
 | 
						struct ismt_priv *priv;
 | 
				
			||||||
 | 
						unsigned long start, len;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
 | 
				
			||||||
 | 
						if (!priv)
 | 
				
			||||||
 | 
							return -ENOMEM;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						pci_set_drvdata(pdev, priv);
 | 
				
			||||||
 | 
						i2c_set_adapdata(&priv->adapter, priv);
 | 
				
			||||||
 | 
						priv->adapter.owner = THIS_MODULE;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						priv->adapter.class = I2C_CLASS_HWMON;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						priv->adapter.algo = &smbus_algorithm;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* set up the sysfs linkage to our parent device */
 | 
				
			||||||
 | 
						priv->adapter.dev.parent = &pdev->dev;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* number of retries on lost arbitration */
 | 
				
			||||||
 | 
						priv->adapter.retries = ISMT_MAX_RETRIES;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						priv->pci_dev = pdev;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						err = pcim_enable_device(pdev);
 | 
				
			||||||
 | 
						if (err) {
 | 
				
			||||||
 | 
							dev_err(&pdev->dev, "Failed to enable SMBus PCI device (%d)\n",
 | 
				
			||||||
 | 
								err);
 | 
				
			||||||
 | 
							return err;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* enable bus mastering */
 | 
				
			||||||
 | 
						pci_set_master(pdev);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						/* Determine the address of the SMBus area */
 | 
				
			||||||
 | 
						start = pci_resource_start(pdev, SMBBAR);
 | 
				
			||||||
 | 
						len = pci_resource_len(pdev, SMBBAR);
 | 
				
			||||||
 | 
						if (!start || !len) {
 | 
				
			||||||
 | 
							dev_err(&pdev->dev,
 | 
				
			||||||
 | 
								"SMBus base address uninitialized, upgrade BIOS\n");
 | 
				
			||||||
 | 
							return -ENODEV;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						snprintf(priv->adapter.name, sizeof(priv->adapter.name),
 | 
				
			||||||
 | 
							 "SMBus iSMT adapter at %lx", start);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						dev_dbg(&priv->pci_dev->dev, " start=0x%lX\n", start);
 | 
				
			||||||
 | 
						dev_dbg(&priv->pci_dev->dev, " len=0x%lX\n", len);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						err = acpi_check_resource_conflict(&pdev->resource[SMBBAR]);
 | 
				
			||||||
 | 
						if (err) {
 | 
				
			||||||
 | 
							dev_err(&pdev->dev, "ACPI resource conflict!\n");
 | 
				
			||||||
 | 
							return err;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						err = pci_request_region(pdev, SMBBAR, ismt_driver.name);
 | 
				
			||||||
 | 
						if (err) {
 | 
				
			||||||
 | 
							dev_err(&pdev->dev,
 | 
				
			||||||
 | 
								"Failed to request SMBus region 0x%lx-0x%lx\n",
 | 
				
			||||||
 | 
								start, start + len);
 | 
				
			||||||
 | 
							return err;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						priv->smba = pcim_iomap(pdev, SMBBAR, len);
 | 
				
			||||||
 | 
						if (!priv->smba) {
 | 
				
			||||||
 | 
							dev_err(&pdev->dev, "Unable to ioremap SMBus BAR\n");
 | 
				
			||||||
 | 
							err = -ENODEV;
 | 
				
			||||||
 | 
							goto fail;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						if ((pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) != 0) ||
 | 
				
			||||||
 | 
						    (pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)) != 0)) {
 | 
				
			||||||
 | 
							if ((pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) != 0) ||
 | 
				
			||||||
 | 
							    (pci_set_consistent_dma_mask(pdev,
 | 
				
			||||||
 | 
											 DMA_BIT_MASK(32)) != 0)) {
 | 
				
			||||||
 | 
								dev_err(&pdev->dev, "pci_set_dma_mask fail %p\n",
 | 
				
			||||||
 | 
									pdev);
 | 
				
			||||||
 | 
								goto fail;
 | 
				
			||||||
 | 
							}
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						err = ismt_dev_init(priv);
 | 
				
			||||||
 | 
						if (err)
 | 
				
			||||||
 | 
							goto fail;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						ismt_hw_init(priv);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						err = ismt_int_init(priv);
 | 
				
			||||||
 | 
						if (err)
 | 
				
			||||||
 | 
							goto fail;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						err = i2c_add_adapter(&priv->adapter);
 | 
				
			||||||
 | 
						if (err) {
 | 
				
			||||||
 | 
							dev_err(&pdev->dev, "Failed to add SMBus iSMT adapter\n");
 | 
				
			||||||
 | 
							err = -ENODEV;
 | 
				
			||||||
 | 
							goto fail;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
						return 0;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					fail:
 | 
				
			||||||
 | 
						pci_release_region(pdev, SMBBAR);
 | 
				
			||||||
 | 
						return err;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_remove() - release driver resources
 | 
				
			||||||
 | 
					 * @pdev: PCI-Express device
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static void ismt_remove(struct pci_dev *pdev)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						struct ismt_priv *priv = pci_get_drvdata(pdev);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						i2c_del_adapter(&priv->adapter);
 | 
				
			||||||
 | 
						pci_release_region(pdev, SMBBAR);
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_suspend() - place the device in suspend
 | 
				
			||||||
 | 
					 * @pdev: PCI-Express device
 | 
				
			||||||
 | 
					 * @mesg: PM message
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					#ifdef CONFIG_PM
 | 
				
			||||||
 | 
					static int ismt_suspend(struct pci_dev *pdev, pm_message_t mesg)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						pci_save_state(pdev);
 | 
				
			||||||
 | 
						pci_set_power_state(pdev, pci_choose_state(pdev, mesg));
 | 
				
			||||||
 | 
						return 0;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/**
 | 
				
			||||||
 | 
					 * ismt_resume() - PCI resume code
 | 
				
			||||||
 | 
					 * @pdev: PCI-Express device
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					static int ismt_resume(struct pci_dev *pdev)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						pci_set_power_state(pdev, PCI_D0);
 | 
				
			||||||
 | 
						pci_restore_state(pdev);
 | 
				
			||||||
 | 
						return pci_enable_device(pdev);
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#else
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#define ismt_suspend NULL
 | 
				
			||||||
 | 
					#define ismt_resume NULL
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#endif
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					static struct pci_driver ismt_driver = {
 | 
				
			||||||
 | 
						.name = "ismt_smbus",
 | 
				
			||||||
 | 
						.id_table = ismt_ids,
 | 
				
			||||||
 | 
						.probe = ismt_probe,
 | 
				
			||||||
 | 
						.remove = ismt_remove,
 | 
				
			||||||
 | 
						.suspend = ismt_suspend,
 | 
				
			||||||
 | 
						.resume = ismt_resume,
 | 
				
			||||||
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					module_pci_driver(ismt_driver);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					MODULE_LICENSE("Dual BSD/GPL");
 | 
				
			||||||
 | 
					MODULE_AUTHOR("Bill E. Brown <bill.e.brown@intel.com>");
 | 
				
			||||||
 | 
					MODULE_DESCRIPTION("Intel SMBus Message Transport (iSMT) driver");
 | 
				
			||||||
		Loading…
	
		Reference in a new issue