From c034f1f6774d47bcc3ab1e17f5c892e94674d38a Mon Sep 17 00:00:00 2001 From: H Hartley Sweeten Date: Mon, 10 Mar 2014 14:07:38 -0700 Subject: [PATCH] staging: comedi: c6xdigio: consolidate the board_init() For aesthetics, rename this function so it has namespace associated with the driver. Absorb the c6xdigio_pwm_init() and c6xdigio_encoder_reset() helpers. Signed-off-by: H Hartley Sweeten Reviewed-by: Ian Abbott Signed-off-by: Greg Kroah-Hartman --- drivers/staging/comedi/drivers/c6xdigio.c | 33 ++++++++++++------------------- 1 file changed, 13 insertions(+), 20 deletions(-) diff --git a/drivers/staging/comedi/drivers/c6xdigio.c b/drivers/staging/comedi/drivers/c6xdigio.c index 63187c5..3937e64 100644 --- a/drivers/staging/comedi/drivers/c6xdigio.c +++ b/drivers/staging/comedi/drivers/c6xdigio.c @@ -93,14 +93,6 @@ static int c6xdigio_get_encoder_bits(struct comedi_device *dev, return c6xdigio_write_data(dev, cmd, status); } -static void c6xdigio_pwm_init(struct comedi_device *dev) -{ - c6xdigio_write_data(dev, 0x70, 0x00); - c6xdigio_write_data(dev, 0x74, 0x80); - c6xdigio_write_data(dev, 0x70, 0x00); - c6xdigio_write_data(dev, 0x00, 0x80); -} - static void c6xdigio_pwm_write(struct comedi_device *dev, unsigned int chan, unsigned int val) { @@ -164,14 +156,6 @@ static int c6xdigio_encoder_read(struct comedi_device *dev, return val ^ 0x800000; } -static void c6xdigio_encoder_reset(struct comedi_device *dev) -{ - c6xdigio_write_data(dev, 0x68, 0x00); - c6xdigio_write_data(dev, 0x6c, 0x80); - c6xdigio_write_data(dev, 0x68, 0x00); - c6xdigio_write_data(dev, 0x00, 0x80); -} - static int c6xdigio_pwm_insn_write(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, @@ -201,10 +185,19 @@ static int c6xdigio_encoder_insn_read(struct comedi_device *dev, return n; } -static void board_init(struct comedi_device *dev) +static void c6xdigio_init(struct comedi_device *dev) { - c6xdigio_pwm_init(dev); - c6xdigio_encoder_reset(dev); + /* Initialize the PWM */ + c6xdigio_write_data(dev, 0x70, 0x00); + c6xdigio_write_data(dev, 0x74, 0x80); + c6xdigio_write_data(dev, 0x70, 0x00); + c6xdigio_write_data(dev, 0x00, 0x80); + + /* Reset the encoders */ + c6xdigio_write_data(dev, 0x68, 0x00); + c6xdigio_write_data(dev, 0x6c, 0x80); + c6xdigio_write_data(dev, 0x68, 0x00); + c6xdigio_write_data(dev, 0x00, 0x80); } static const struct pnp_device_id c6xdigio_pnp_tbl[] = { @@ -257,7 +250,7 @@ static int c6xdigio_attach(struct comedi_device *dev, /* I will call this init anyway but more than likely the DSP board */ /* will not be connected when device driver is loaded. */ - board_init(dev); + c6xdigio_init(dev); return 0; } -- 2.7.4