Lines Matching refs:solo_dev
25 u8 solo_i2c_readbyte(struct solo6010_dev *solo_dev, int id, u8 addr, u8 off)
40 i2c_transfer(&solo_dev->i2c_adap[id], msgs, 2);
45 void solo_i2c_writebyte(struct solo6010_dev *solo_dev, int id, u8 addr,
58 i2c_transfer(&solo_dev->i2c_adap[id], &msgs, 1);
61 static void solo_i2c_flush(struct solo6010_dev *solo_dev, int wr)
65 ctrl = SOLO_IIC_CH_SET(solo_dev->i2c_id);
67 if (solo_dev->i2c_state == IIC_STATE_START)
74 if (!(solo_dev->i2c_msg->flags & I2C_M_NO_RD_ACK))
78 if (solo_dev->i2c_msg_ptr == solo_dev->i2c_msg->len)
81 solo_reg_write(solo_dev, SOLO_IIC_CTRL, ctrl);
84 static void solo_i2c_start(struct solo6010_dev *solo_dev)
86 u32 addr = solo_dev->i2c_msg->addr << 1;
88 if (solo_dev->i2c_msg->flags & I2C_M_RD)
91 solo_dev->i2c_state = IIC_STATE_START;
92 solo_reg_write(solo_dev, SOLO_IIC_TXD, addr);
93 solo_i2c_flush(solo_dev, 1);
96 static void solo_i2c_stop(struct solo6010_dev *solo_dev)
98 solo6010_irq_off(solo_dev, SOLO_IRQ_IIC);
99 solo_reg_write(solo_dev, SOLO_IIC_CTRL, 0);
100 solo_dev->i2c_state = IIC_STATE_STOP;
101 wake_up(&solo_dev->i2c_wait);
104 static int solo_i2c_handle_read(struct solo6010_dev *solo_dev)
107 if (solo_dev->i2c_msg_ptr != solo_dev->i2c_msg->len) {
108 solo_i2c_flush(solo_dev, 0);
112 solo_dev->i2c_msg_ptr = 0;
113 solo_dev->i2c_msg++;
114 solo_dev->i2c_msg_num--;
116 if (solo_dev->i2c_msg_num == 0) {
117 solo_i2c_stop(solo_dev);
121 if (!(solo_dev->i2c_msg->flags & I2C_M_NOSTART)) {
122 solo_i2c_start(solo_dev);
124 if (solo_dev->i2c_msg->flags & I2C_M_RD)
127 solo_i2c_stop(solo_dev);
133 static int solo_i2c_handle_write(struct solo6010_dev *solo_dev)
136 if (solo_dev->i2c_msg_ptr != solo_dev->i2c_msg->len) {
137 solo_reg_write(solo_dev, SOLO_IIC_TXD,
138 solo_dev->i2c_msg->buf[solo_dev->i2c_msg_ptr]);
139 solo_dev->i2c_msg_ptr++;
140 solo_i2c_flush(solo_dev, 1);
144 solo_dev->i2c_msg_ptr = 0;
145 solo_dev->i2c_msg++;
146 solo_dev->i2c_msg_num--;
148 if (solo_dev->i2c_msg_num == 0) {
149 solo_i2c_stop(solo_dev);
153 if (!(solo_dev->i2c_msg->flags & I2C_M_NOSTART)) {
154 solo_i2c_start(solo_dev);
156 if (solo_dev->i2c_msg->flags & I2C_M_RD)
157 solo_i2c_stop(solo_dev);
165 int solo_i2c_isr(struct solo6010_dev *solo_dev)
167 u32 status = solo_reg_read(solo_dev, SOLO_IIC_CTRL);
170 solo_reg_write(solo_dev, SOLO_IRQ_STAT, SOLO_IRQ_IIC);
173 solo_dev->i2c_id < 0) {
174 solo_i2c_stop(solo_dev);
178 switch (solo_dev->i2c_state) {
180 if (solo_dev->i2c_msg->flags & I2C_M_RD) {
181 solo_dev->i2c_state = IIC_STATE_READ;
182 ret = solo_i2c_handle_read(solo_dev);
186 solo_dev->i2c_state = IIC_STATE_WRITE;
188 ret = solo_i2c_handle_write(solo_dev);
192 solo_dev->i2c_msg->buf[solo_dev->i2c_msg_ptr] =
193 solo_reg_read(solo_dev, SOLO_IIC_RXD);
194 solo_dev->i2c_msg_ptr++;
196 ret = solo_i2c_handle_read(solo_dev);
200 solo_i2c_stop(solo_dev);
209 struct solo6010_dev *solo_dev = adap->algo_data;
216 if (&solo_dev->i2c_adap[i] == adap)
223 down(&solo_dev->i2c_sem);
224 solo_dev->i2c_id = i;
225 solo_dev->i2c_msg = msgs;
226 solo_dev->i2c_msg_num = num;
227 solo_dev->i2c_msg_ptr = 0;
229 solo_reg_write(solo_dev, SOLO_IIC_CTRL, 0);
230 solo6010_irq_on(solo_dev, SOLO_IRQ_IIC);
231 solo_i2c_start(solo_dev);
236 prepare_to_wait(&solo_dev->i2c_wait, &wait, TASK_INTERRUPTIBLE);
238 if (solo_dev->i2c_state == IIC_STATE_STOP)
249 finish_wait(&solo_dev->i2c_wait, &wait);
250 ret = num - solo_dev->i2c_msg_num;
251 solo_dev->i2c_state = IIC_STATE_IDLE;
252 solo_dev->i2c_id = -1;
254 up(&solo_dev->i2c_sem);
269 int solo_i2c_init(struct solo6010_dev *solo_dev)
274 solo_reg_write(solo_dev, SOLO_IIC_CFG,
277 solo_dev->i2c_id = -1;
278 solo_dev->i2c_state = IIC_STATE_IDLE;
279 init_waitqueue_head(&solo_dev->i2c_wait);
280 init_MUTEX(&solo_dev->i2c_sem);
283 struct i2c_adapter *adap = &solo_dev->i2c_adap[i];
288 adap->algo_data = solo_dev;
290 adap->dev.parent = &solo_dev->pdev->dev;
300 if (!solo_dev->i2c_adap[i].algo_data)
302 i2c_del_adapter(&solo_dev->i2c_adap[i]);
303 solo_dev->i2c_adap[i].algo_data = NULL;
308 dev_info(&solo_dev->pdev->dev, "Enabled %d i2c adapters\n",
314 void solo_i2c_exit(struct solo6010_dev *solo_dev)
319 if (!solo_dev->i2c_adap[i].algo_data)
321 i2c_del_adapter(&solo_dev->i2c_adap[i]);
322 solo_dev->i2c_adap[i].algo_data = NULL;