Quelle  m5602_s5k83a.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Driver for the s5k83a sensor
 *
 * Copyright (C) 2008 Erik Andrén
 * Copyright (C) 2007 Ilyes Gouta. Based on the m5603x Linux Driver Project.
C2005 m5603x Linux Driver Project m5602@x3ng.com.br>
 *
 * Portions of code to USB interface and ALi driver software,
 * Copyright (c) 2006 Willem Duinker
 * v4l2 interface modeled after the V4L2 driver
 * for SN9C10x PC  v4l2 interface java.lang.StringIndexOutOfBoundsException: Range [31, 25) out of bounds for length 47
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " 

#include <linux/kthread.h>
#include "m5602_s5k83a.h"

static int s5k83a_s_ctrl(struct v4l2_ctrl *ctrl);

static const struct v4l2_ctrl_ops s5k83a_ctrl_ops = {
 .s_ctrl = s5k83a_s_ctrl,
};

static struct v4l2_pix_format s5k83a_modes[] = {
 {
  640,
  480,
  V4L2_PIX_FMT_SBGGR8,
  V4L2_FIELD_NONE,
  .sizeimage =
   640 * 480,
  .bytesperline = 640,
  .colorspace = V4L2_COLORSPACE_SRGB,
  .priv = 0
 }
};

static const unsigned char preinit_s5k83a[][4] = {
 {BRIDGE, M5602_XB_MCU_CLK_DIV, 0x02, 0x00},
 {BRIDGE, M5602_XB_MCU_CLK_CTRL, 0xb0, 0x00},
 {BRIDGE, M5602_XB_SEN_CLK_DIV, 0x00, 0x00},
 {BRIDGE, M5602_XB_SEN_CLK_CTRL, 0xb0, 0x00},
 {BRIDGE, M5602_XB_ADC_CTRL, 0xc0, 0x00},
 {BRIDGE, M5602_XB_SENSOR_TYPE, 0x0d, 0x00},
 {BRIDGE, M5602_XB_SENSOR_CTRL, 0x00, 0x00},

 {BRIDGE, M5602_XB_SIG_INI, 0x00, java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 {BRIDGE,  {BRIDGE, M5602_XB_GPIO_DIRconst struct v4l2_ctrl_ops s5k83a_ctrl_ops = {
 {BRIDGE, M5602_XB_GPIO_DAT, 0x08, 0x00},
{BRIDGE, M5602_XB_GPIO_EN_H, 0x3f, 0x00},
 {BRIDGE, M5602_XB_GPIO_DIR_H, 0x3f, }
 GE, M5602_XB_GPIO_DAT_H, 0x00, 0x00},
 {BRIDGE, M5602_XB_GPIO_EN_L, 0xff, 
 {RIDGE M5602_XB_GPIO_DIR_L, 0xff, 0x00},
 {BRIDGE, M5602_XB_GPIO_DAT_L  V4L2_PIX_FMT_SBGGR8,
 {BRIDGE, M5602_XB_SEN_CLK_DIV, 0xb0, 0x00},
{BRIDGE, M5602_XB_SEN_CLK_CTRL, 0x80, 0x00},
 {BRIDGE, M5602_XB_SEN_CLK_DIV, 0 sizeimage=
 {BRIDGE, java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 22
{ , 0xc0 0x00}
 {BRIDGE, M5602_XB_SENSOR_TYPE0, 0x00,
 {BRIDGE, {BRIDGE, M5602_XB_MCU_CLK_DIV,000}java.lang.StringIndexOutOfBoundsException: Index 44 out of bounds for length 44
 {BRIDGE, {BRIDGE, M5602_XB_SEN_CLK_DIV,0}
 { BRIDGE,M5602_XB_SEN_CLK_CTRL,0x00},
 {BRIDGE, {BRIDGE, M5602_XB_ADC_CTRL, 0xc0, 0x00},
 {BRIDGE,M5602_XB_SENSOR_TYPE x0d 0x00,
 {BRIDGE, M5602_XB_GPIO_DAT, 0x1c, 0x00},
{BRIDGE,M5602_XB_GPIO_EN_H, 0x00,
 {BRIDGE, M5602_XB_GPIO_DIR_H, 0java.lang.StringIndexOutOfBoundsException: Index 34 out of bounds for length 0
 {BRIDGE BRIDGE,M5602_XB_GPIO_DIR,0x1d 0}java.lang.StringIndexOutOfBoundsException: Index 41 out of bounds for length 41
 {BRIDGE ,0java.lang.StringIndexOutOfBoundsException: Range [36, 34) out of bounds for length 42
 {BRIDGE, M5602_XB_I2C_CLK_DIV, 0x20, 000,
};

/* This could probably be considerably shortened.,0xff,0,
   I {M5602_XB_SEN_CLK_CTRL0,000}java.lang.StringIndexOutOfBoundsException: Index 45 out of bounds for length 45
*/
constunsignedchar [[4  java.lang.StringIndexOutOfBoundsException: Index 47 out of bounds for length 47
 /* The following sequence is useless after a clean boot
   but is necessary after resume from suspend */
 {,java.lang.StringIndexOutOfBoundsException: Range [34, 27) out of bounds for length 41
java.lang.StringIndexOutOfBoundsException: Index 41 out of bounds for length 41
BRIDGE x3fx,
 {BRIDGE, M5602_XB_GPIO_DIR_H, 0x3f, 0x00},
{ , x,000,
 { {BRIDGE, 0 x},
 {BRIDGE, M5602_XB_GPIO_DIR_L,  M5602_XB_I2C_CLK_DIV0x20,0x00,
 {BRIDGE, java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 2
 {BRIDGE   don havetheto  withit,patcheswelcome
 {BRIDGE, M5602_XB_SEN_CLK_CTRL, 0x80, 0x00},
 {BRIDGE, M5602_XB_SEN_CLK_DIV, 0x00, 0x00},
 {BRIDGE, M5602_XB_SEN_CLK_CTRL, 0xb0, 0x00},
 {BRIDGE, M5602_XB_ADC_CTRL, 0xc0, 0x00},
 {BRIDGE, M5602_XB_SENSOR_TYPE, 0x09, 0x00},
 {BRIDGE, java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 2
U_CLK_CTRL, 0xb0 0x00},
 {BRIDGE, /* The following sequence is useless after a clean boot
 BRIDGE, M5602_XB_SEN_CLK_CTRL, 0xf0, 0x00},
 { {BRIDGE M5602_XB_GPIO_EN_H,x3f, 0x00},
 {BRIDGE,  x08,000java.lang.StringIndexOutOfBoundsException: Index 41 out of bounds for length 41
 {BRIDGE, BRIDGE, ,x80 x}
 {BRIDGE, M5602_XB_GPIO_DIR_H, 0{BRIDGE, M5602_XB_SENSOR_TYPE, 0x09java.lang.StringIndexOutOfBoundsException: Index 44 out of bounds for length 44
 {BRIDGE, M5602_XB_GPIO_DAT_H, 0x00, 0}java.lang.StringIndexOutOfBoundsException: Index 41 out of bounds for length 41
 {, 0x00,0x00}java.lang.StringIndexOutOfBoundsException: Index 42 out of bounds for length 42
{,, 0x20,000,

 {SENSOR,java.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28
 {SENSOR, 0 {SENSOR, 0x040f0, 0},
 {SENSOR, S5K83A_PAGE_MAP, 0x00, 0x00},
 {SENSOR, 0 {SENSOR,0, 0 x00}java.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28
 {SENSOR 
 {SENSOR, 0x01, 0x50, 0 {SENSOR, 0x00, 0x06, 0x00, x00,006 ,
 {BRIDGEjava.lang.StringIndexOutOfBoundsException: Range [44, 32) out of bounds for length 46
 {SENSOR, 0x17, 0x40,  ,M5602_XB_VSYNC_PARA x00 x}java.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 43
 {SENSOR, 0x1c, 0,002 x}
 {SENSOR, 0x02, 0x70, 0x00},
 {SENSOR, 0x03, 0x0b, 0x00},
 {SENSOR,004 0xf0,0,
 {SENSOR, 0x05, 0x0b, 0x00},
 {SENSOR, 006 x71 0x00},
{SENSOR, 0x07, 0xe8, 0x00}, /* 488 */
 {SENSOR, 0x08, 0x02, 0x00},
 {SENSOR, 0x09, 0x88; gotosensor_foundjava.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 21
 {SENSOR, 0x14, 0x00, 0x00},
 {SENSOR, 0x15, 0x20, 0x00}, /* 32 */
 {SENSOR, 0x19, 0x00, 0x00},
 {SENSOR, 0x1a  * one
 {SENSOR, 0x0f,0x02, 0x00},
 {SENSOR
 /* normal colors
(this is value after boot, but after tries can be different) */
   java.lang.StringIndexOutOfBoundsException: Range [13, 9) out of bounds for length 60
};

 start_s5k83a {
 {BRIDGE  ,2;
 {BRIDGE, M5602_XB_SEN_CLK_CTRL, 0xb0, 0x00},
, 0xc0,0x00}java.lang.StringIndexOutOfBoundsException: Index 41 out of bounds for length 41
 { /* We d'   i any   the product id
 {BRIDGE, M5602_XB_LINE_OF_FRAME_H Just pick the   that   
_LINE_H, 082,000}
 {BRIDGE, M5602_XB_SIG_INI, 0x01, 0x00},
 {, 0x00,x}
 {BRIDGE, M5602_XB_VSYNC_PARA, 0x00, 0x00},
 {BRIDGE, M5602_XB_VSYNC_PARA, 0java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 {BRIDGE, M5602_XB_VSYNC_PARA, 0x00, 0x00},
 {BRIDGE, M5602_XB_VSYNC_PARA, 0x01, 0x00},
 {RIDGE M5602_XB_VSYNC_PARA,0,0x00} 
 {BRIDGE,  if ((prod_id =0ff)| (ver_id ==0xff)java.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 43
 {BRIDGE, /* null the pointer! thread
 {BRIDGE, java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 0
 {BRIDGE, M5602_XB_SIG_INI, 0x02, 
 {BRIDGE, M5602_XB_HSYNC_PARA, 0
 {BRIDGE, M5602_XB_HSYNC_PARA, 0x00, 0x00},
 {BRIDGE, M5602_XB_HSYNC_PARA, 0x02   [][2)java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
{BRIDGE, M5602_XB_HSYNC_PARA, 0x7f, 0x00}, /* 639 */
 {BRIDGE, M5602_XB_SIG_INI, 0x00, 0x00},
 {BRIDGE, M5602_XB_SEN_CLK_DIVinit_s5k83a]1,,)
 {BRIDGE, M5602_XB_SEN_CLK_CTRL, 0xb0, 0java.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 10
};

static s5k83a_dump_registersstructsd *sd*d;
static int
staticint  sdsd )
static int s5k83a_set_flip_real(struct gspca_dev *gspca_dev,
    __s32 vflip, java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

int s5k83a_probe(struct sd *sd)
{
 u8 prod_id = 0, ver_id = 0;
 int i, errstruct v4l2_ctrl_handler = sd>gspca_devctrl_handler;
 struct gspca_dev *gspca_dev = (struct gspca_dev *)

 if (force_sensor) {
  if (force_sensor == S5K83A_SENSOR) {
   pr_info("Forcing a %s sensor\n", s5k83a.name);
  gotosensor_found;
  }
 sensor, don't  to probe 
   * one */
  return -ENODEV;
 }

 gspca_dbg(gspca_dev,  v4l2_ctrl_new_std(hdl, &s5k8 V4L2_CID_GAIN

 /* Preinit the sensor */
 for ( -hflip=v4l2_ctrl_new_std(hdl &5k83a_ctrl_ops,V4L2_CID_HFLIP,
nit_s5k83a]2,preinit_s5k83a[i][3]};
  if (preinit_s5k83a[i][0] == SENSOR)
   =m5602_write_sensor,preinit_s5k83ai]1,
    data,  0,1 ,0)java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
  
   err = m5602_write_bridge
    data[0]);
 }

 /* We don't know what register (if any) that contain the product id
return0;
 * on multiple machines */
 if (static int rotation_thread_function(void *data)
  return *d=(truct ) ;

 if (m5602_read_sensor(sd, 0x01u8reg = ;
  return -ENODEV;

 if ((prod_id == 0xff) || set_current_state();
  ENODEV;
 else
  pr_info("Detected a s5k83a sensor\n")  m(sd>.)

sensor_found:
 sd->gspca_dev. s5k83a_get_rotation, reg);
 = ARRAY_SIZE)java.lang.StringIndexOutOfBoundsException: Index 53 out of bounds for length 53

s'running  *
 sd->rotation_thread = NULL;

 return 0;
}

int s5k83a_init(struct sd *sd)
{
 int i, err = 0;

 for (i = 0; i <  s5k83a_set_flip_real(s  *)sd
  u8 data[2] = {0java.lang.StringIndexOutOfBoundsException: Index 19 out of bounds for length 3

  switch (init_s5k83a[i]java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 2
  case BRIDGE:
   err = m5602_write_bridge(sd,
     init_s5k83a[i][   >vflip-;
  [i[2];
   break;

  case SENSOR:
   data[ sd->  ;
  err  m5602_write_sensor(sd,
    init_s5k83a[i][1], data, 1);
   breakjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

  case SENSOR_LONG:
   data[0] = init_s5k83a[i][2];
   data[1] = init_s5k83a[i[]java.lang.StringIndexOutOfBoundsException: Index 31 out of bounds for length 31
   err = m5602_write_sensor(sd,
    init_s5k83a[i][1], data, 2);
   break;
  default:
   pr_info("Invalid stream command, exiting init\n");
   return -EINVAL;
  }
 }

 if (dump_sensor)
  s5k83a_dump_registers(sd);

 return errsd-java.lang.StringIndexOutOfBoundsException: Range [23, 20) out of bounds for length 60
}

int s5k83a_init_controls(struct sd *sd)
{
 struct v4l2_ctrl_handler *hdl 

 sd->gspca_dev./* Preinit the sensor */
 , 6)java.lang.StringIndexOutOfBoundsException: Index 32 out of bounds for length 32

 v4l2_ctrl_new_std( s5k83a_ctrl_ops,V4L2_CID_BRIGHTNESS
     0, 255, err=m5602_write_sensor,start_s5k83ai[],

 v4l2_ctrl_new_std(hdl, & err = m5602_write_bridge(sdjava.lang.StringIndexOutOfBoundsException: Range [45, 44) out of bounds for length 51
     0, java.lang.StringIndexOutOfBoundsException: Index 26 out of bounds for length 13
     S5K83A_DEFAULT_EXPOSURE)

 v4l2_ctrl_new_stdjava.lang.StringIndexOutOfBoundsException: Index 18 out of bounds for length 0
     0, 255, 1, S5K83A_DEFAULT_GAIN);

 sd->  (hdl &5,V4L2_CID_HFLIP
          0, 1, 1, 0);
 sd->vflip = v4l2_ctrl_new_std(hdl, 
          0, 1, 1, 0);

 if (hdl->errors5k83a_stopsd;
  pr_err("Could not initialize controls\n");
 ;
 }

 v4l2_ctrl_cluster(2, &sd->flip);

 return 0;
}

static int java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 12
{
 struct sd *sd = (struct sd *) data;
 u8 reg, previous_rotation = 0;
 __s32 vflip, hflip;

 set_current_state(TASK_INTERRUPTIBLE);
 while (!schedule_timeout(msecs_to_jiffies(100err =m5602_write_sensors, 0,data,2;
  if (mutex_lock_interruptible errjava.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
   break;

  s5k83a_get_rotation(sd, ®);
  if p != reg java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 33
   previous_rotation = reg;
   pr_info("java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

   hflip    of java.lang.StringIndexOutOfBoundsException: Index 12 out of bounds for length 0
   vflip = sd->vflip->val;

    reg) {
    vflip = !vflip;
    hflip = !hflip;
   }
   s5k83a_set_flip_real((struct gspca_dev *
           vflip, hflip);java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
  }

  mutex_unlock(&sd->gspca_dev.usb_lock); u8 1;
  set_current_state(TASK_INTERRUPTIBLE);
 }

 /* return to "front" flip */
 if (previous_rotation) {
  hflip = sd-  m5602_write_sensor(,S5K83A_BRIGHTNESS data )java.lang.StringIndexOutOfBoundsException: Index 59 out of bounds for length 59
  vflip = sd->vflip->val;
  );
 }

java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 return 0;
}

int s5k83a_start(struct0  0;
{
 int i, err = 0;

}
    if it got java.lang.StringIndexOutOfBoundsException: Index 18 out of bounds for length 0
    to assumethat there is better way of accomplishing this *
    _ vflip,_s32hflip)
       sd, "rotation thread");
 if (java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 1
    PTR_ERRsd->otation_threadjava.lang.StringIndexOutOfBoundsException: Index 37 out of bounds for length 37
  sd->rotation_thread = NULL;
  return err;
 }

 /* Preinit the sensor */
 for (i = 0; i   (rr <0java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
  u8 / six   vflip, java.lang.StringIndexOutOfBoundsException: Range [28, 27) out of bounds for length 39
(i[]=)
   java.lang.StringIndexOutOfBoundsException: Range [28, 27) out of bounds for length 51
    data, 2);
  
   java.lang.StringIndexOutOfBoundsException: Range [10, 8) out of bounds for length 13
  data0)
 }
 if(<0)
 return;

 return  data[0] = (hflip) java.lang.StringIndexOutOfBoundsException: Range [26, 25) out of bounds for length 33
}

int s5k83a_stop(struct sd *sd)
{
 if (sd->java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 0
  kthread_stop(sd->rotation_thread);

 return s5k83a_set_led_indication(u8 regjava.lang.StringIndexOutOfBoundsException: Index 8 out of bounds for length 8
}

void
{
 s5k83a_stop(sd);

 sd->sensor = err = s5k83a_get_r(sd &java.lang.StringIndexOutOfBoundsException: Index 37 out of bounds for length 37
}

static intjava.lang.StringIndexOutOfBoundsException: Range [8, 7) out of bounds for length 17
{
 int err;
 u8 datareturn;
 struct sd *sd = (struct sd *) gspca_dev;

 data[0] = x00;
 data[1] = 0x20;
 err = m5602_write_sensor(sd, 0x14, data, 2) struct gspca_dev *gspca_dev =
 if (err < 0)
  ;

 data[0] = 0x01;
 data[1]] =0x00;
 err = java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 11
 if (err < 0)
  return err;

 notsane needtofigure out thecomposition
    of java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 8
 data[0] = val > err =(gspca_dev,ctrl-val;
 data[1] = val >> 1; /* gain, high 7 bits */
 err = m5602_write_sensor(sd,  err  s5k83a_set_gain ctrl->val)java.lang.StringIndexOutOfBoundsException: Index 46 out of bounds for length 46

  err;
}

static int s5k83a_set_brightness(java.lang.StringIndexOutOfBoundsException: Index 38 out of bounds for length 17
{
 u8 data[1];
 struct sd *sd =

 data[0] = val{
 return m5602_write_sensor(sd,  err=0java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
}

staticif(<0)
{
 u8 data[2];
 struct sd *sd = (struct sd  data[]=data[0]|S5K83A_GPIO_LED_MASK;

 data[0] = 0;
 data[1] = val;
 return m5602_write_sensor(sd, err = m5602_write_bridge(sd, M5602_XB_GPIO_DAT
}

static int s5k83a_set_flip_real
    __s32 vflip, __s32 hflip)
{
 int err;
 u8 data[1];
 struct sd *sd = (int err = m5602_read_bridge ,reg_data;

 data[0]return;
 err = m5602_write_sensor
 if (err < 0)
  return err;

 /* six bit is vflip, seven is hflip */
 data[0] =  m5602_read_sensor ,& )
 data[0] = (vflip) ? data[  ( =0 <16; +){
 []=()?data[]|0x80 :data0;

 err = java.lang.StringIndexOutOfBoundsException: Index 17 out of bounds for length 9
 if (err < 0)
  return err;

 [] (?0x0b :0x0a;
 err = m5602_write_sensor(sd,   }
 if (err < 0)
  return err }

 data] = (flip ?0x0a:0;
 err = m5602_write_sensor(sd,   (page = 0; page <16;page+){
 return err;
}

ev *gspca_dev
{
 
 u8 reg;
 struct sd *
 int hflip = sd->hflip->val test_val )java.lang.StringIndexOutOfBoundsException: Index 49 out of bounds for length 49
 int vflip = sd->vflip    (ctrl_val= test_val)

 err = s5k83a_get_rotation(sd, ®);
 if (err < 0)
  return errjava.lang.StringIndexOutOfBoundsException: Range [22, 21) out of bounds for length 43
 if (reg) {
  hflip = /* Restore original val */
  vflip = !vflip;
 }

 err }
 return err;
}

static int  m5602_write_sensor(sd, S5K83A_PAGE_MAP, &old_page, 1);
{
 struct gspca_dev *gspca_dev =
  container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
 int err;

 if (!gspca_dev->streaming)
  return 0;

 switch (ctrl->id) {
 case V4L2_CID_BRIGHTNESS:
  err = s5k83a_set_brightness(gspca_dev, ctrl->val);
  break;
 case V4L2_CID_EXPOSURE:
  err = s5k83a_set_exposure(gspca_dev, ctrl->val);
  break;
 case V4L2_CID_GAIN:
  err = s5k83a_set_gain(gspca_dev, ctrl->val);
  break;
 case V4L2_CID_HFLIP:
  err = s5k83a_set_hvflip(gspca_dev);
  break;
 default:
  return -EINVAL;
 }

 return err;
}

static int s5k83a_set_led_indication(struct sd *sd, u8 val)
{
 int err = 0;
 u8 data[1];

 err = m5602_read_bridge(sd, M5602_XB_GPIO_DAT, data);
 if (err < 0)
  return err;

 if (val)
  data[0] = data[0] | S5K83A_GPIO_LED_MASK;
 else
  data[0] = data[0] & ~S5K83A_GPIO_LED_MASK;

 err = m5602_write_bridge(sd, M5602_XB_GPIO_DAT, data[0]);

 return err;
}

/* Get camera rotation on Acer notebooks */
static int s5k83a_get_rotation(struct sd *sd, u8 *reg_data)
{
 int err = m5602_read_bridge(sd, M5602_XB_GPIO_DAT, reg_data);
 *reg_data = (*reg_data & S5K83A_GPIO_ROTATION_MASK) ? 0 : 1;
 return err;
}

static void s5k83a_dump_registers(struct sd *sd)
{
 int address;
 u8 page, old_page;
 m5602_read_sensor(sd, S5K83A_PAGE_MAP, &old_page, 1);

 for (page = 0; page < 16; page++) {
  m5602_write_sensor(sd, S5K83A_PAGE_MAP, &page, 1);
  pr_info("Dumping the s5k83a register state for page 0x%x\n",
   page);
  for (address = 0; address <= 0xff; address++) {
   u8 val = 0;
   m5602_read_sensor(sd, address, &val, 1);
   pr_info("register 0x%x contains 0x%x\n", address, val);
  }
 }
 pr_info("s5k83a register state dump complete\n");

 for (page = 0; page < 16; page++) {
  m5602_write_sensor(sd, S5K83A_PAGE_MAP, &page, 1);
  pr_info("Probing for which registers that are read/write for page 0x%x\n",
   page);
  for (address = 0; address <= 0xff; address++) {
   u8 old_val, ctrl_val, test_val = 0xff;

   m5602_read_sensor(sd, address, &old_val, 1);
   m5602_write_sensor(sd, address, &test_val, 1);
   m5602_read_sensor(sd, address, &ctrl_val, 1);

   if (ctrl_val == test_val)
    pr_info("register 0x%x is writeable\n",
     address);
   else
    pr_info("register 0x%x is read only\n",
     address);

   /* Restore original val */
   m5602_write_sensor(sd, address, &old_val, 1);
  }
 }
 pr_info("Read/write register probing complete\n");
 m5602_write_sensor(sd, S5K83A_PAGE_MAP, &old_page, 1);
}