drivers/i2c/busses/i2c-amd756-s4882.c

   1 /*
   2  * i2c-amd756-s4882.c - i2c-amd756 extras for the Tyan S4882 motherboard
   3  *
   4  * Copyright (C) 2004, 2008 Jean Delvare <khali@linux-fr.org>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, write to the Free Software
  18  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  19  */
  20
  21 /*
  22  * We select the channels by sending commands to the Philips
  23  * PCA9556 chip at I2C address 0x18. The main adapter is used for
  24  * the non-multiplexed part of the bus, and 4 virtual adapters
  25  * are defined for the multiplexed addresses: 0x50-0x53 (memory
  26  * module EEPROM) located on channels 1-4, and 0x4c (LM63)
  27  * located on multiplexed channels 0 and 5-7. We define one
  28  * virtual adapter per CPU, which corresponds to two multiplexed
  29  * channels:
  30  *   CPU0: virtual adapter 1, channels 1 and 0
  31  *   CPU1: virtual adapter 2, channels 2 and 5
  32  *   CPU2: virtual adapter 3, channels 3 and 6
  33  *   CPU3: virtual adapter 4, channels 4 and 7
  34  */
  35
  36 #include <linux/module.h>
  37 #include <linux/kernel.h>
  38 #include <linux/slab.h>
  39 #include <linux/init.h>
  40 #include <linux/i2c.h>
  41 #include <linux/mutex.h>
  42
  43 extern struct i2c_adapter amd756_smbus;
  44
  45 static struct i2c_adapter *s4882_adapter;
  46 static struct i2c_algorithm *s4882_algo;
  47
  48 /* Wrapper access functions for multiplexed SMBus */
  49 static DEFINE_MUTEX(amd756_lock);
  50
  51 static s32 amd756_access_virt0(struct i2c_adapter * adap, u16 addr,
  52                                unsigned short flags, char read_write,
  53                                u8 command, int size,
  54                                union i2c_smbus_data * data)
  55 {
  56         int error;
  57
  58         /* We exclude the multiplexed addresses */
  59         if (addr == 0x4c || (addr & 0xfc) == 0x50 || (addr & 0xfc) == 0x30
  60          || addr == 0x18)
  61                 return -ENXIO;
  62
  63         mutex_lock(&amd756_lock);
  64
  65         error = amd756_smbus.algo->smbus_xfer(adap, addr, flags, read_write,
  66                                               command, size, data);
  67
  68         mutex_unlock(&amd756_lock);
  69
  70         return error;
  71 }
  72
  73 /* We remember the last used channels combination so as to only switch
  74    channels when it is really needed. This greatly reduces the SMBus
  75    overhead, but also assumes that nobody will be writing to the PCA9556
  76    in our back. */
  77 static u8 last_channels;
  78
  79 static inline s32 amd756_access_channel(struct i2c_adapter * adap, u16 addr,
  80                                         unsigned short flags, char read_write,
  81                                         u8 command, int size,
  82                                         union i2c_smbus_data * data,
  83                                         u8 channels)
  84 {
  85         int error;
  86
  87         /* We exclude the non-multiplexed addresses */
  88         if (addr != 0x4c && (addr & 0xfc) != 0x50 && (addr & 0xfc) != 0x30)
  89                 return -ENXIO;
  90
  91         mutex_lock(&amd756_lock);
  92
  93         if (last_channels != channels) {
  94                 union i2c_smbus_data mplxdata;
  95                 mplxdata.byte = channels;
  96
  97                 error = amd756_smbus.algo->smbus_xfer(adap, 0x18, 0,
  98                                                       I2C_SMBUS_WRITE, 0x01,
  99                                                       I2C_SMBUS_BYTE_DATA,
 100                                                       &mplxdata);
 101                 if (error)
 102                         goto UNLOCK;
 103                 last_channels = channels;
 104         }
 105         error = amd756_smbus.algo->smbus_xfer(adap, addr, flags, read_write,
 106                                               command, size, data);
 107
 108 UNLOCK:
 109         mutex_unlock(&amd756_lock);
 110         return error;
 111 }
 112
 113 static s32 amd756_access_virt1(struct i2c_adapter * adap, u16 addr,
 114                                unsigned short flags, char read_write,
 115                                u8 command, int size,
 116                                union i2c_smbus_data * data)
 117 {
 118         /* CPU0: channels 1 and 0 enabled */
 119         return amd756_access_channel(adap, addr, flags, read_write, command,
 120                                      size, data, 0x03);
 121 }
 122
 123 static s32 amd756_access_virt2(struct i2c_adapter * adap, u16 addr,
 124                                unsigned short flags, char read_write,
 125                                u8 command, int size,
 126                                union i2c_smbus_data * data)
 127 {
 128         /* CPU1: channels 2 and 5 enabled */
 129         return amd756_access_channel(adap, addr, flags, read_write, command,
 130                                      size, data, 0x24);
 131 }
 132
 133 static s32 amd756_access_virt3(struct i2c_adapter * adap, u16 addr,
 134                                unsigned short flags, char read_write,
 135                                u8 command, int size,
 136                                union i2c_smbus_data * data)
 137 {
 138         /* CPU2: channels 3 and 6 enabled */
 139         return amd756_access_channel(adap, addr, flags, read_write, command,
 140                                      size, data, 0x48);
 141 }
 142
 143 static s32 amd756_access_virt4(struct i2c_adapter * adap, u16 addr,
 144                                unsigned short flags, char read_write,
 145                                u8 command, int size,
 146                                union i2c_smbus_data * data)
 147 {
 148         /* CPU3: channels 4 and 7 enabled */
 149         return amd756_access_channel(adap, addr, flags, read_write, command,
 150                                      size, data, 0x90);
 151 }
 152
 153 static int __init amd756_s4882_init(void)
 154 {
 155         int i, error;
 156         union i2c_smbus_data ioconfig;
 157
 158         if (!amd756_smbus.dev.parent)
 159                 return -ENODEV;
 160
 161         /* Configure the PCA9556 multiplexer */
 162         ioconfig.byte = 0x00; /* All I/O to output mode */
 163         error = i2c_smbus_xfer(&amd756_smbus, 0x18, 0, I2C_SMBUS_WRITE, 0x03,
 164                                I2C_SMBUS_BYTE_DATA, &ioconfig);
 165         if (error) {
 166                 dev_err(&amd756_smbus.dev, "PCA9556 configuration failed\n");
 167                 error = -EIO;
 168                 goto ERROR0;
 169         }
 170
 171         /* Unregister physical bus */
 172         error = i2c_del_adapter(&amd756_smbus);
 173         if (error) {
 174                 dev_err(&amd756_smbus.dev, "Physical bus removal failed\n");
 175                 goto ERROR0;
 176         }
 177
 178         printk(KERN_INFO "Enabling SMBus multiplexing for Tyan S4882\n");
 179         /* Define the 5 virtual adapters and algorithms structures */
 180         if (!(s4882_adapter = kzalloc(5 * sizeof(struct i2c_adapter),
 181                                       GFP_KERNEL))) {
 182                 error = -ENOMEM;
 183                 goto ERROR1;
 184         }
 185         if (!(s4882_algo = kzalloc(5 * sizeof(struct i2c_algorithm),
 186                                    GFP_KERNEL))) {
 187                 error = -ENOMEM;
 188                 goto ERROR2;
 189         }
 190
 191         /* Fill in the new structures */
 192         s4882_algo[0] = *(amd756_smbus.algo);
 193         s4882_algo[0].smbus_xfer = amd756_access_virt0;
 194         s4882_adapter[0] = amd756_smbus;
 195         s4882_adapter[0].algo = s4882_algo;
 196         s4882_adapter[0].dev.parent = amd756_smbus.dev.parent;
 197         for (i = 1; i < 5; i++) {
 198                 s4882_algo[i] = *(amd756_smbus.algo);
 199                 s4882_adapter[i] = amd756_smbus;
 200                 snprintf(s4882_adapter[i].name, sizeof(s4882_adapter[i].name),
 201                          "SMBus 8111 adapter (CPU%d)", i-1);
 202                 s4882_adapter[i].algo = s4882_algo+i;
 203                 s4882_adapter[i].dev.parent = amd756_smbus.dev.parent;
 204         }
 205         s4882_algo[1].smbus_xfer = amd756_access_virt1;
 206         s4882_algo[2].smbus_xfer = amd756_access_virt2;
 207         s4882_algo[3].smbus_xfer = amd756_access_virt3;
 208         s4882_algo[4].smbus_xfer = amd756_access_virt4;
 209
 210         /* Register virtual adapters */
 211         for (i = 0; i < 5; i++) {
 212                 error = i2c_add_adapter(s4882_adapter+i);
 213                 if (error) {
 214                         printk(KERN_ERR "i2c-amd756-s4882: "
 215                                "Virtual adapter %d registration "
 216                                "failed, module not inserted\n", i);
 217                         for (i--; i >= 0; i--)
 218                                 i2c_del_adapter(s4882_adapter+i);
 219                         goto ERROR3;
 220                 }
 221         }
 222
 223         return 0;
 224
 225 ERROR3:
 226         kfree(s4882_algo);
 227         s4882_algo = NULL;
 228 ERROR2:
 229         kfree(s4882_adapter);
 230         s4882_adapter = NULL;
 231 ERROR1:
 232         /* Restore physical bus */
 233         i2c_add_adapter(&amd756_smbus);
 234 ERROR0:
 235         return error;
 236 }
 237
 238 static void __exit amd756_s4882_exit(void)
 239 {
 240         if (s4882_adapter) {
 241                 int i;
 242
 243                 for (i = 0; i < 5; i++)
 244                         i2c_del_adapter(s4882_adapter+i);
 245                 kfree(s4882_adapter);
 246                 s4882_adapter = NULL;
 247         }
 248         kfree(s4882_algo);
 249         s4882_algo = NULL;
 250
 251         /* Restore physical bus */
 252         if (i2c_add_adapter(&amd756_smbus))
 253                 printk(KERN_ERR "i2c-amd756-s4882: "
 254                        "Physical bus restoration failed\n");
 255 }
 256
 257 MODULE_AUTHOR("Jean Delvare <khali@linux-fr.org>");
 258 MODULE_DESCRIPTION("S4882 SMBus multiplexing");
 259 MODULE_LICENSE("GPL");
 260
 261 module_init(amd756_s4882_init);
 262 module_exit(amd756_s4882_exit);