1/* 2 * Copyright 2009 Red Hat Inc. 3 * 4 * Permission is hereby granted, free of charge, to any person obtaining a 5 * copy of this software and associated documentation files (the "Software"), 6 * to deal in the Software without restriction, including without limitation 7 * the rights to use, copy, modify, merge, publish, distribute, sublicense, 8 * and/or sell copies of the Software, and to permit persons to whom the 9 * Software is furnished to do so, subject to the following conditions: 10 * 11 * The above copyright notice and this permission notice shall be included in 12 * all copies or substantial portions of the Software. 13 * 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR 18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, 19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR 20 * OTHER DEALINGS IN THE SOFTWARE. 21 * 22 * Authors: Ben Skeggs 23 */ 24 25#include "priv.h" 26 27int 28nv_rdaux(struct nouveau_i2c_port *port, u32 addr, u8 *data, u8 size) 29{ 30 struct nouveau_i2c *i2c = nouveau_i2c(port); 31 if (port->func->aux) { 32 int ret = i2c->acquire(port, 0); 33 if (ret == 0) { 34 ret = port->func->aux(port, true, 9, addr, data, size); 35 i2c->release(port); 36 } 37 return ret; 38 } 39 return -ENODEV; 40} 41 42int 43nv_wraux(struct nouveau_i2c_port *port, u32 addr, u8 *data, u8 size) 44{ 45 struct nouveau_i2c *i2c = nouveau_i2c(port); 46 if (port->func->aux) { 47 int ret = i2c->acquire(port, 0); 48 if (ret == 0) { 49 ret = port->func->aux(port, true, 8, addr, data, size); 50 i2c->release(port); 51 } 52 return ret; 53 } 54 return -ENODEV; 55} 56 57static int 58aux_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num) 59{ 60 struct nouveau_i2c_port *port = adap->algo_data; 61 struct nouveau_i2c *i2c = nouveau_i2c(port); 62 struct i2c_msg *msg = msgs; 63 int ret, mcnt = num; 64 65 if (!port->func->aux) 66 return -ENODEV; 67 68 ret = i2c->acquire(port, 0); 69 if (ret) 70 return ret; 71 72 while (mcnt--) { 73 u8 remaining = msg->len; 74 u8 *ptr = msg->buf; 75 76 while (remaining) { 77 u8 cnt = (remaining > 16) ? 16 : remaining; 78 u8 cmd; 79 80 if (msg->flags & I2C_M_RD) 81 cmd = 1; 82 else 83 cmd = 0; 84 85 if (mcnt || remaining > 16) 86 cmd |= 4; /* MOT */ 87 88 ret = port->func->aux(port, true, cmd, msg->addr, ptr, cnt); 89 if (ret < 0) { 90 i2c->release(port); 91 return ret; 92 } 93 94 ptr += cnt; 95 remaining -= cnt; 96 } 97 98 msg++; 99 } 100 101 i2c->release(port); 102 return num; 103} 104 105static u32 106aux_func(struct i2c_adapter *adap) 107{ 108 return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; 109} 110 111const struct i2c_algorithm nouveau_i2c_aux_algo = { 112 .master_xfer = aux_xfer, 113 .functionality = aux_func 114}; 115