/* * mxl111sf-gpio.c - driver for the MaxLinear MXL111SF * * Copyright (C) 2010 Michael Krufky * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * 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., 675 Mass Ave, Cambridge, MA 02139, USA. */ #include "mxl111sf-gpio.h" #include "mxl111sf-i2c.h" #include "mxl111sf.h" /* ------------------------------------------------------------------------- */ #define MXL_GPIO_MUX_REG_0 0x84 #define MXL_GPIO_MUX_REG_1 0x89 #define MXL_GPIO_MUX_REG_2 0x82 #define MXL_GPIO_DIR_INPUT 0 #define MXL_GPIO_DIR_OUTPUT 1 static int mxl111sf_set_gpo_state(struct mxl111sf_state *state, u8 pin, u8 val) { int ret; u8 tmp; mxl_debug_adv("(%d, %d)", pin, val); if ((pin > 0) && (pin < 8)) { ret = mxl111sf_read_reg(state, 0x19, &tmp); if (mxl_fail(ret)) goto fail; tmp &= ~(1 << (pin - 1)); tmp |= (val << (pin - 1)); ret = mxl111sf_write_reg(state, 0x19, tmp); if (mxl_fail(ret)) goto fail; } else if (pin <= 10) { if (pin == 0) pin += 7; ret = mxl111sf_read_reg(state, 0x30, &tmp); if (mxl_fail(ret)) goto fail; tmp &= ~(1 << (pin - 3)); tmp |= (val << (pin - 3)); ret = mxl111sf_write_reg(state, 0x30, tmp); if (mxl_fail(ret)) goto fail; } else ret = -EINVAL; fail: return ret; } static int mxl111sf_get_gpi_state(struct mxl111sf_state *state, u8 pin, u8 *val) { int ret; u8 tmp; mxl_debug("(0x%02x)", pin); *val = 0; switch (pin) { case 0: case 1: case 2: case 3: ret = mxl111sf_read_reg(state, 0x23, &tmp); if (mxl_fail(ret)) goto fail; *val = (tmp >> (pin + 4)) & 0x01; break; case 4: case 5: case 6: case 7: ret = mxl111sf_read_reg(state, 0x2f, &tmp); if (mxl_fail(ret)) goto fail; *val = (tmp >> pin) & 0x01; break; case 8: case 9: case 10: ret = mxl111sf_read_reg(state, 0x22, &tmp); if (mxl_fail(ret)) goto fail; *val = (tmp >> (pin - 3)) & 0x01; break; default: return -EINVAL; /* invalid pin */ } fail: return ret; } struct mxl_gpio_cfg { u8 pin; u8 dir; u8 val; }; static int mxl111sf_config_gpio_pins(struct mxl111sf_state *state, struct mxl_gpio_cfg *gpio_cfg) { int ret; u8 tmp; mxl_debug_adv("(%d, %d)", gpio_cfg->pin, gpio_cfg->dir); switch (gpio_cfg->pin) { case 0: case 1: case 2: case 3: ret = mxl111sf_read_reg(state, MXL_GPIO_MUX_REG_0, &tmp); if (mxl_fail(ret)) goto fail; tmp &= ~(1 << (gpio_cfg->pin + 4)); tmp |= (gpio_cfg->dir << (gpio_cfg->pin + 4)); ret = mxl111sf_write_reg(state, MXL_GPIO_MUX_REG_0, tmp); if (mxl_fail(ret)) goto fail; break; case 4: case 5: case 6: case 7: ret = mxl111sf_read_reg(state, MXL_GPIO_MUX_REG_1, &tmp); if (mxl_fail(ret)) goto fail; tmp &= ~(1 << gpio_cfg->pin); tmp |= (gpio_cfg->dir << gpio_cfg->pin); ret = mxl111sf_write_reg(state, MXL_GPIO_MUX_REG_1, tmp); if (mxl_fail(ret)) goto fail; break; case 8: case 9: case 10: ret = mxl111sf_read_reg(state, MXL_GPIO_MUX_REG_2, &tmp); if (mxl_fail(ret)) goto fail; tmp &= ~(1 << (gpio_cfg->pin - 3)); tmp |= (gpio_cfg->dir << (gpio_cfg->pin - 3)); ret = mxl111sf_write_reg(state, MXL_GPIO_MUX_REG_2, tmp); if (mxl_fail(ret)) goto fail; break; default: return -EINVAL; /* invalid pin */ } ret = (MXL_GPIO_DIR_OUTPUT == gpio_cfg->dir) ? mxl111sf_set_gpo_state(state, gpio_cfg->pin, gpio_cfg->val) : mxl111sf_get_gpi_state(state, gpio_cfg->pin, &gpio_cfg->val); mxl_fail(ret); fail: return ret; } static int mxl111sf_hw_do_set_gpio(struct mxl111sf_state *state, int gpio, int direction, int val) { struct mxl_gpio_cfg gpio_config = { .pin = gpio, .dir = direction, .val = val, }; mxl_debug("(%d, %d, %d)", gpio, direction, val); return mxl111sf_config_gpio_pins(state, &gpio_config); } /* ------------------------------------------------------------------------- */ #define PIN_MUX_MPEG_MODE_MASK 0x40 /* 0x17 <6> */ #define PIN_MUX_MPEG_PAR_EN_MASK 0x01 /* 0x18 <0> */ #define PIN_MUX_MPEG_SER_EN_MASK 0x02 /* 0x18 <1> */ #define PIN_MUX_MPG_IN_MUX_MASK 0x80 /* 0x3D <7> */ #define PIN_MUX_BT656_ENABLE_MASK 0x04 /* 0x12 <2> */ #define PIN_MUX_I2S_ENABLE_MASK 0x40 /* 0x15 <6> */ #define PIN_MUX_SPI_MODE_MASK 0x10 /* 0x3D <4> */ #define PIN_MUX_MCLK_EN_CTRL_MASK 0x10 /* 0x82 <4> */ #define PIN_MUX_MPSYN_EN_CTRL_MASK 0x20 /* 0x82 <5> */ #define PIN_MUX_MDVAL_EN_CTRL_MASK 0x40 /* 0x82 <6> */ #define PIN_MUX_MPERR_EN_CTRL_MASK 0x80 /* 0x82 <7> */ #define PIN_MUX_MDAT_EN_0_MASK 0x10 /* 0x84 <4> */ #define PIN_MUX_MDAT_EN_1_MASK 0x20 /* 0x84 <5> */ #define PIN_MUX_MDAT_EN_2_MASK 0x40 /* 0x84 <6> */ #define PIN_MUX_MDAT_EN_3_MASK 0x80 /* 0x84 <7> */ #define PIN_MUX_MDAT_EN_4_MASK 0x10 /* 0x89 <4> */ #define PIN_MUX_MDAT_EN_5_MASK 0x20 /* 0x89 <5> */ #define PIN_MUX_MDAT_EN_6_MASK 0x40 /* 0x89 <6> */ #define PIN_MUX_MDAT_EN_7_MASK 0x80 /* 0x89 <7> */ int mxl111sf_config_pin_mux_modes(struct mxl111sf_state *state, enum mxl111sf_mux_config pin_mux_config) { u8 r12, r15, r17, r18, r3D, r82, r84, r89; int ret; mxl_debug("(%d)", pin_mux_config); ret = mxl111sf_read_reg(state, 0x17, &r17); if (mxl_fail(ret)) goto fail; ret = mxl111sf_read_reg(state, 0x18, &r18); if (mxl_fail(ret)) goto fail; ret = mxl111sf_read_reg(state, 0x12, &r12); if (mxl_fail(ret)) goto fail; ret = mxl111sf_read_reg(state, 0x15, &r15); if (mxl_fail(ret)) goto fail; ret = mxl111sf_read_reg(state, 0x82, &r82); if (mxl_fail(ret)) goto fail; ret = mxl111sf_read_reg(state, 0x84, &r84); if (mxl_fail(ret)) goto fail; ret = mxl111sf_read_reg(state, 0x89, &r89); if (mxl_fail(ret)) goto fail; ret = mxl111sf_read_reg(state, 0x3D, &r3D); if (mxl_fail(ret)) goto fail; switch (pin_mux_config) { case PIN_MUX_TS_OUT_PARALLEL: /* mpeg_mode = 1 */ r17 |= PIN_MUX_MPEG_MODE_MASK; /* mpeg_par_en = 1 */ r18 |= PIN_MUX_MPEG_PAR_EN_MASK; /* mpeg_ser_en = 0 */ r18 &= ~PIN_MUX_MPEG_SER_EN_MASK; /* mpg_in_mux = 0 */ r3D &= ~PIN_MUX_MPG_IN_MUX_MASK; /* bt656_enable = 0 */ r12 &= ~PIN_MUX_BT656_ENABLE_MASK; /* i2s_enable = 0 */ r15 &= ~PIN_MUX_I2S_ENABLE_MASK; /* spi_mode = 0 */ r3D &= ~PIN_MUX_SPI_MODE_MASK; /* mclk_en_ctrl = 1 */ r82 |= PIN_MUX_MCLK_EN_CTRL_MASK; /* mperr_en_ctrl = 1 */ r82 |= PIN_MUX_MPERR_EN_CTRL_MASK; /* mdval_en_ctrl = 1 */ r82 |= PIN_MUX_MDVAL_EN_CTRL_MASK; /* mpsyn_en_ctrl = 1 */ r82 |= PIN_MUX_MPSYN_EN_CTRL_MASK; /* mdat_en_ctrl[3:0] = 0xF */ r84 |= 0xF0; /* mdat_en_ctrl[7:4] = 0xF */ r89 |= 0xF0; break; case PIN_MUX_TS_OUT_SERIAL: /* mpeg_mode = 1 */ r17 |= PIN_MUX_MPEG_MODE_MASK; /* mpeg_par_en = 0 */ r18 &= ~PIN_MUX_MPEG_PAR_EN_MASK; /* mpeg_ser_en = 1 */ r18 |= PIN_MUX_MPEG_SER_EN_MASK; /* mpg_in_mux = 0 */ r3D &= ~PIN_MUX_MPG_IN_MUX_MASK; /* bt656_enable = 0 */ r12 &= ~PIN_MUX_BT656_ENABLE_MASK; /* i2s_enable = 0 */ r15 &= ~PIN_MUX_I2S_ENABLE_MASK; /* spi_mode = 0 */ r3D &= ~PIN_MUX_SPI_MODE_MASK; /* mclk_en_ctrl = 1 */ r82 |= PIN_MUX_MCLK_EN_CTRL_MASK; /* mperr_en_ctrl = 1 */ r82 |= PIN_MUX_MPERR_EN_CTRL_MASK; /* mdval_en_ctrl = 1 */ r82 |= PIN_MUX_MDVAL_EN_CTRL_MASK; /* mpsyn_en_ctrl = 1 */ r82 |= PIN_MUX_MPSYN_EN_CTRL_MASK; /* mdat_en_ctrl[3:0] = 0xF */ r84 |= 0xF0; /* mdat_en_ctrl[7:4] = 0xF */ r89 |= 0xF0; break; case PIN_MUX_GPIO_MODE: /* mpeg_mode = 0 */ r17 &= ~PIN_MUX_MPEG_MODE_MASK; /* mpeg_par_en = 0 */ r18 &= ~PIN_MUX_MPEG_PAR_EN_MASK; /* mpeg_ser_en = 0 */ r18 &= ~PIN_MUX_MPEG_SER_EN_MASK; /* mpg_in_mux = 0 */ r3D &= ~PIN_MUX_MPG_IN_MUX_MASK; /* bt656_enable = 0 */ r12 &= ~PIN_MUX_BT656_ENABLE_MASK; /* i2s_enable = 0 */ r15 &= ~PIN_MUX_I2S_ENABLE_MASK; /* spi_mode = 0 */ r3D &= ~PIN_MUX_SPI_MODE_MASK; /* mclk_en_ctrl = 0 */ r82 &= ~PIN_MUX_MCLK_EN_CTRL_MASK; /* mperr_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPERR_EN_CTRL_MASK; /* mdval_en_ctrl = 0 */ r82 &= ~PIN_MUX_MDVAL_EN_CTRL_MASK; /* mpsyn_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPSYN_EN_CTRL_MASK; /* mdat_en_ctrl[3:0] = 0x0 */ r84 &= 0x0F; /* mdat_en_ctrl[7:4] = 0x0 */ r89 &= 0x0F; break; case PIN_MUX_TS_SERIAL_IN_MODE_0: /* mpeg_mode = 0 */ r17 &= ~PIN_MUX_MPEG_MODE_MASK; /* mpeg_par_en = 0 */ r18 &= ~PIN_MUX_MPEG_PAR_EN_MASK; /* mpeg_ser_en = 1 */ r18 |= PIN_MUX_MPEG_SER_EN_MASK; /* mpg_in_mux = 0 */ r3D &= ~PIN_MUX_MPG_IN_MUX_MASK; /* bt656_enable = 0 */ r12 &= ~PIN_MUX_BT656_ENABLE_MASK; /* i2s_enable = 0 */ r15 &= ~PIN_MUX_I2S_ENABLE_MASK; /* spi_mode = 0 */ r3D &= ~PIN_MUX_SPI_MODE_MASK; /* mclk_en_ctrl = 0 */ r82 &= ~PIN_MUX_MCLK_EN_CTRL_MASK; /* mperr_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPERR_EN_CTRL_MASK; /* mdval_en_ctrl = 0 */ r82 &= ~PIN_MUX_MDVAL_EN_CTRL_MASK; /* mpsyn_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPSYN_EN_CTRL_MASK; /* mdat_en_ctrl[3:0] = 0x0 */ r84 &= 0x0F; /* mdat_en_ctrl[7:4] = 0x0 */ r89 &= 0x0F; break; case PIN_MUX_TS_SERIAL_IN_MODE_1: /* mpeg_mode = 0 */ r17 &= ~PIN_MUX_MPEG_MODE_MASK; /* mpeg_par_en = 0 */ r18 &= ~PIN_MUX_MPEG_PAR_EN_MASK; /* mpeg_ser_en = 1 */ r18 |= PIN_MUX_MPEG_SER_EN_MASK; /* mpg_in_mux = 1 */ r3D |= PIN_MUX_MPG_IN_MUX_MASK; /* bt656_enable = 0 */ r12 &= ~PIN_MUX_BT656_ENABLE_MASK; /* i2s_enable = 0 */ r15 &= ~PIN_MUX_I2S_ENABLE_MASK; /* spi_mode = 0 */ r3D &= ~PIN_MUX_SPI_MODE_MASK; /* mclk_en_ctrl = 0 */ r82 &= ~PIN_MUX_MCLK_EN_CTRL_MASK; /* mperr_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPERR_EN_CTRL_MASK; /* mdval_en_ctrl = 0 */ r82 &= ~PIN_MUX_MDVAL_EN_CTRL_MASK; /* mpsyn_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPSYN_EN_CTRL_MASK; /* mdat_en_ctrl[3:0] = 0x0 */ r84 &= 0x0F; /* mdat_en_ctrl[7:4] = 0x0 */ r89 &= 0x0F; break; case PIN_MUX_TS_SPI_IN_MODE_1: /* mpeg_mode = 0 */ r17 &= ~PIN_MUX_MPEG_MODE_MASK; /* mpeg_par_en = 0 */ r18 &= ~PIN_MUX_MPEG_PAR_EN_MASK; /* mpeg_ser_en = 1 */ r18 |= PIN_MUX_MPEG_SER_EN_MASK; /* mpg_in_mux = 1 */ r3D |= PIN_MUX_MPG_IN_MUX_MASK; /* bt656_enable = 0 */ r12 &= ~PIN_MUX_BT656_ENABLE_MASK; /* i2s_enable = 1 */ r15 |= PIN_MUX_I2S_ENABLE_MASK; /* spi_mode = 1 */ r3D |= PIN_MUX_SPI_MODE_MASK; /* mclk_en_ctrl = 0 */ r82 &= ~PIN_MUX_MCLK_EN_CTRL_MASK; /* mperr_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPERR_EN_CTRL_MASK; /* mdval_en_ctrl = 0 */ r82 &= ~PIN_MUX_MDVAL_EN_CTRL_MASK; /* mpsyn_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPSYN_EN_CTRL_MASK; /* mdat_en_ctrl[3:0] = 0x0 */ r84 &= 0x0F; /* mdat_en_ctrl[7:4] = 0x0 */ r89 &= 0x0F; break; case PIN_MUX_TS_SPI_IN_MODE_0: /* mpeg_mode = 0 */ r17 &= ~PIN_MUX_MPEG_MODE_MASK; /* mpeg_par_en = 0 */ r18 &= ~PIN_MUX_MPEG_PAR_EN_MASK; /* mpeg_ser_en = 1 */ r18 |= PIN_MUX_MPEG_SER_EN_MASK; /* mpg_in_mux = 0 */ r3D &= ~PIN_MUX_MPG_IN_MUX_MASK; /* bt656_enable = 0 */ r12 &= ~PIN_MUX_BT656_ENABLE_MASK; /* i2s_enable = 1 */ r15 |= PIN_MUX_I2S_ENABLE_MASK; /* spi_mode = 1 */ r3D |= PIN_MUX_SPI_MODE_MASK; /* mclk_en_ctrl = 0 */ r82 &= ~PIN_MUX_MCLK_EN_CTRL_MASK; /* mperr_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPERR_EN_CTRL_MASK; /* mdval_en_ctrl = 0 */ r82 &= ~PIN_MUX_MDVAL_EN_CTRL_MASK; /* mpsyn_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPSYN_EN_CTRL_MASK; /* mdat_en_ctrl[3:0] = 0x0 */ r84 &= 0x0F; /* mdat_en_ctrl[7:4] = 0x0 */ r89 &= 0x0F; break; case PIN_MUX_TS_PARALLEL_IN: /* mpeg_mode = 0 */ r17 &= ~PIN_MUX_MPEG_MODE_MASK; /* mpeg_par_en = 1 */ r18 |= PIN_MUX_MPEG_PAR_EN_MASK; /* mpeg_ser_en = 0 */ r18 &= ~PIN_MUX_MPEG_SER_EN_MASK; /* mpg_in_mux = 0 */ r3D &= ~PIN_MUX_MPG_IN_MUX_MASK; /* bt656_enable = 0 */ r12 &= ~PIN_MUX_BT656_ENABLE_MASK; /* i2s_enable = 0 */ r15 &= ~PIN_MUX_I2S_ENABLE_MASK; /* spi_mode = 0 */ r3D &= ~PIN_MUX_SPI_MODE_MASK; /* mclk_en_ctrl = 0 */ r82 &= ~PIN_MUX_MCLK_EN_CTRL_MASK; /* mperr_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPERR_EN_CTRL_MASK; /* mdval_en_ctrl = 0 */ r82 &= ~PIN_MUX_MDVAL_EN_CTRL_MASK; /* mpsyn_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPSYN_EN_CTRL_MASK; /* mdat_en_ctrl[3:0] = 0x0 */ r84 &= 0x0F; /* mdat_en_ctrl[7:4] = 0x0 */ r89 &= 0x0F; break; case PIN_MUX_BT656_I2S_MODE: /* mpeg_mode = 0 */ r17 &= ~PIN_MUX_MPEG_MODE_MASK; /* mpeg_par_en = 0 */ r18 &= ~PIN_MUX_MPEG_PAR_EN_MASK; /* mpeg_ser_en = 0 */ r18 &= ~PIN_MUX_MPEG_SER_EN_MASK; /* mpg_in_mux = 0 */ r3D &= ~PIN_MUX_MPG_IN_MUX_MASK; /* bt656_enable = 1 */ r12 |= PIN_MUX_BT656_ENABLE_MASK; /* i2s_enable = 1 */ r15 |= PIN_MUX_I2S_ENABLE_MASK; /* spi_mode = 0 */ r3D &= ~PIN_MUX_SPI_MODE_MASK; /* mclk_en_ctrl = 0 */ r82 &= ~PIN_MUX_MCLK_EN_CTRL_MASK; /* mperr_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPERR_EN_CTRL_MASK; /* mdval_en_ctrl = 0 */ r82 &= ~PIN_MUX_MDVAL_EN_CTRL_MASK; /* mpsyn_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPSYN_EN_CTRL_MASK; /* mdat_en_ctrl[3:0] = 0x0 */ r84 &= 0x0F; /* mdat_en_ctrl[7:4] = 0x0 */ r89 &= 0x0F; break; case PIN_MUX_DEFAULT: default: /* mpeg_mode = 1 */ r17 |= PIN_MUX_MPEG_MODE_MASK; /* mpeg_par_en = 0 */ r18 &= ~PIN_MUX_MPEG_PAR_EN_MASK; /* mpeg_ser_en = 0 */ r18 &= ~PIN_MUX_MPEG_SER_EN_MASK; /* mpg_in_mux = 0 */ r3D &= ~PIN_MUX_MPG_IN_MUX_MASK; /* bt656_enable = 0 */ r12 &= ~PIN_MUX_BT656_ENABLE_MASK; /* i2s_enable = 0 */ r15 &= ~PIN_MUX_I2S_ENABLE_MASK; /* spi_mode = 0 */ r3D &= ~PIN_MUX_SPI_MODE_MASK; /* mclk_en_ctrl = 0 */ r82 &= ~PIN_MUX_MCLK_EN_CTRL_MASK; /* mperr_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPERR_EN_CTRL_MASK; /* mdval_en_ctrl = 0 */ r82 &= ~PIN_MUX_MDVAL_EN_CTRL_MASK; /* mpsyn_en_ctrl = 0 */ r82 &= ~PIN_MUX_MPSYN_EN_CTRL_MASK; /* mdat_en_ctrl[3:0] = 0x0 */ r84 &= 0x0F; /* mdat_en_ctrl[7:4] = 0x0 */ r89 &= 0x0F; break; } ret = mxl111sf_write_reg(state, 0x17, r17); if (mxl_fail(ret)) goto fail; ret = mxl111sf_write_reg(state, 0x18, r18); if (mxl_fail(ret)) goto fail; ret = mxl111sf_write_reg(state, 0x12, r12); if (mxl_fail(ret)) goto fail; ret = mxl111sf_write_reg(state, 0x15, r15); if (mxl_fail(ret)) goto fail; ret = mxl111sf_write_reg(state, 0x82, r82); if (mxl_fail(ret)) goto fail; ret = mxl111sf_write_reg(state, 0x84, r84); if (mxl_fail(ret)) goto fail; ret = mxl111sf_write_reg(state, 0x89, r89); if (mxl_fail(ret)) goto fail; ret = mxl111sf_write_reg(state, 0x3D, r3D); if (mxl_fail(ret)) goto fail; fail: return ret; } /* ------------------------------------------------------------------------- */ static int mxl111sf_hw_set_gpio(struct mxl111sf_state *state, int gpio, int val) { return mxl111sf_hw_do_set_gpio(state, gpio, MXL_GPIO_DIR_OUTPUT, val); } static int mxl111sf_hw_gpio_initialize(struct mxl111sf_state *state) { u8 gpioval = 0x07; /* write protect enabled, signal LEDs off */ int i, ret; mxl_debug("()"); for (i = 3; i < 8; i++) { ret = mxl111sf_hw_set_gpio(state, i, (gpioval >> i) & 0x01); if (mxl_fail(ret)) break; } return ret; } #define PCA9534_I2C_ADDR (0x40 >> 1) static int pca9534_set_gpio(struct mxl111sf_state *state, int gpio, int val) { u8 w[2] = { 1, 0 }; u8 r = 0; struct i2c_msg msg[] = { { .addr = PCA9534_I2C_ADDR, .flags = 0, .buf = w, .len = 1 }, { .addr = PCA9534_I2C_ADDR, .flags = I2C_M_RD, .buf = &r, .len = 1 }, }; mxl_debug("(%d, %d)", gpio, val); /* read current GPIO levels from flip-flop */ i2c_transfer(&state->d->i2c_adap, msg, 2); /* prepare write buffer with current GPIO levels */ msg[0].len = 2; #if 0 w[0] = 1; #endif w[1] = r; /* clear the desired GPIO */ w[1] &= ~(1 << gpio); /* set the desired GPIO value */ w[1] |= ((val ? 1 : 0) << gpio); /* write new GPIO levels to flip-flop */ i2c_transfer(&state->d->i2c_adap, &msg[0], 1); return 0; } static int pca9534_init_port_expander(struct mxl111sf_state *state) { u8 w[2] = { 1, 0x07 }; /* write protect enabled, signal LEDs off */ struct i2c_msg msg = { .addr = PCA9534_I2C_ADDR, .flags = 0, .buf = w, .len = 2 }; mxl_debug("()"); i2c_transfer(&state->d->i2c_adap, &msg, 1); /* configure all pins as outputs */ w[0] = 3; w[1] = 0; i2c_transfer(&state->d->i2c_adap, &msg, 1); return 0; } int mxl111sf_set_gpio(struct mxl111sf_state *state, int gpio, int val) { mxl_debug("(%d, %d)", gpio, val); switch (state->gpio_port_expander) { default: mxl_printk(KERN_ERR, "gpio_port_expander undefined, assuming PCA9534"); /* fall-thru */ case mxl111sf_PCA9534: return pca9534_set_gpio(state, gpio, val); case mxl111sf_gpio_hw: return mxl111sf_hw_set_gpio(state, gpio, val); } } static int mxl111sf_probe_port_expander(struct mxl111sf_state *state) { int ret; u8 w = 1; u8 r = 0; struct i2c_msg msg[] = { { .flags = 0, .buf = &w, .len = 1 }, { .flags = I2C_M_RD, .buf = &r, .len = 1 }, }; mxl_debug("()"); msg[0].addr = 0x70 >> 1; msg[1].addr = 0x70 >> 1; /* read current GPIO levels from flip-flop */ ret = i2c_transfer(&state->d->i2c_adap, msg, 2); if (ret == 2) { state->port_expander_addr = msg[0].addr; state->gpio_port_expander = mxl111sf_PCA9534; mxl_debug("found port expander at 0x%02x", state->port_expander_addr); return 0; } msg[0].addr = 0x40 >> 1; msg[1].addr = 0x40 >> 1; ret = i2c_transfer(&state->d->i2c_adap, msg, 2); if (ret == 2) { state->port_expander_addr = msg[0].addr; state->gpio_port_expander = mxl111sf_PCA9534; mxl_debug("found port expander at 0x%02x", state->port_expander_addr); return 0; } state->port_expander_addr = 0xff; state->gpio_port_expander = mxl111sf_gpio_hw; mxl_debug("using hardware gpio"); return 0; } int mxl111sf_init_port_expander(struct mxl111sf_state *state) { mxl_debug("()"); if (0x00 == state->port_expander_addr) mxl111sf_probe_port_expander(state); switch (state->gpio_port_expander) { default: mxl_printk(KERN_ERR, "gpio_port_expander undefined, assuming PCA9534"); /* fall-thru */ case mxl111sf_PCA9534: return pca9534_init_port_expander(state); case mxl111sf_gpio_hw: return mxl111sf_hw_gpio_initialize(state); } } /* ------------------------------------------------------------------------ */ int mxl111sf_gpio_mode_switch(struct mxl111sf_state *state, unsigned int mode) { /* GPO: * 3 - ATSC/MH# | 1 = ATSC transport, 0 = MH transport | default 0 * 4 - ATSC_RST## | 1 = ATSC enable, 0 = ATSC Reset | default 0 * 5 - ATSC_EN | 1 = ATSC power enable, 0 = ATSC power off | default 0 * 6 - MH_RESET# | 1 = MH enable, 0 = MH Reset | default 0 * 7 - MH_EN | 1 = MH power enable, 0 = MH power off | default 0 */ mxl_debug("(%d)", mode); switch (mode) { case MXL111SF_GPIO_MOD_MH: mxl111sf_set_gpio(state, 4, 0); mxl111sf_set_gpio(state, 5, 0); msleep(50); mxl111sf_set_gpio(state, 7, 1); msleep(50); mxl111sf_set_gpio(state, 6, 1); msleep(50); mxl111sf_set_gpio(state, 3, 0); break; case MXL111SF_GPIO_MOD_ATSC: mxl111sf_set_gpio(state, 6, 0); mxl111sf_set_gpio(state, 7, 0); msleep(50); mxl111sf_set_gpio(state, 5, 1); msleep(50); mxl111sf_set_gpio(state, 4, 1); msleep(50); mxl111sf_set_gpio(state, 3, 1); break; default: /* DVBT / STANDBY */ mxl111sf_init_port_expander(state); break; } return 0; } /* * Local variables: * c-basic-offset: 8 * End: */