1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
|
/*
* Driver for the po1030 sensor.
*
* Copyright (c) 2008 Erik Andrén
* Copyright (c) 2007 Ilyes Gouta. Based on the m5603x Linux Driver Project.
* Copyright (c) 2005 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 Camera Controllers
*
* Register defines taken from Pascal Stangs Procyon Armlib
*
* 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, version 2.
*
*/
#ifndef M5602_PO1030_H_
#define M5602_PO1030_H_
#include "m5602_sensor.h"
/*****************************************************************************/
#define PO1030_DEVID_H 0x00
#define PO1030_DEVID_L 0x01
#define PO1030_FRAMEWIDTH_H 0x04
#define PO1030_FRAMEWIDTH_L 0x05
#define PO1030_FRAMEHEIGHT_H 0x06
#define PO1030_FRAMEHEIGHT_L 0x07
#define PO1030_WINDOWX_H 0x08
#define PO1030_WINDOWX_L 0x09
#define PO1030_WINDOWY_H 0x0a
#define PO1030_WINDOWY_L 0x0b
#define PO1030_WINDOWWIDTH_H 0x0c
#define PO1030_WINDOWWIDTH_L 0x0d
#define PO1030_WINDOWHEIGHT_H 0x0e
#define PO1030_WINDOWHEIGHT_L 0x0f
#define PO1030_GLOBALIBIAS 0x12
#define PO1030_PIXELIBIAS 0x13
#define PO1030_GLOBALGAIN 0x15
#define PO1030_RED_GAIN 0x16
#define PO1030_GREEN_1_GAIN 0x17
#define PO1030_BLUE_GAIN 0x18
#define PO1030_GREEN_2_GAIN 0x19
#define PO1030_INTEGLINES_H 0x1a
#define PO1030_INTEGLINES_M 0x1b
#define PO1030_INTEGLINES_L 0x1c
#define PO1030_CONTROL1 0x1d
#define PO1030_CONTROL2 0x1e
#define PO1030_CONTROL3 0x1f
#define PO1030_CONTROL4 0x20
#define PO1030_PERIOD50_H 0x23
#define PO1030_PERIOD50_L 0x24
#define PO1030_PERIOD60_H 0x25
#define PO1030_PERIOD60_L 0x26
#define PO1030_REGCLK167 0x27
#define PO1030_FLICKER_DELTA50 0x28
#define PO1030_FLICKERDELTA60 0x29
#define PO1030_ADCOFFSET 0x2c
/* Gamma Correction Coeffs */
#define PO1030_GC0 0x2d
#define PO1030_GC1 0x2e
#define PO1030_GC2 0x2f
#define PO1030_GC3 0x30
#define PO1030_GC4 0x31
#define PO1030_GC5 0x32
#define PO1030_GC6 0x33
#define PO1030_GC7 0x34
/* Color Transform Matrix */
#define PO1030_CT0 0x35
#define PO1030_CT1 0x36
#define PO1030_CT2 0x37
#define PO1030_CT3 0x38
#define PO1030_CT4 0x39
#define PO1030_CT5 0x3a
#define PO1030_CT6 0x3b
#define PO1030_CT7 0x3c
#define PO1030_CT8 0x3d
#define PO1030_AUTOCTRL1 0x3e
#define PO1030_AUTOCTRL2 0x3f
#define PO1030_YTARGET 0x40
#define PO1030_GLOBALGAINMIN 0x41
#define PO1030_GLOBALGAINMAX 0x42
#define PO1030_AWB_RED_TUNING 0x47
#define PO1030_AWB_BLUE_TUNING 0x48
/* Output format control */
#define PO1030_OUTFORMCTRL1 0x5a
#define PO1030_OUTFORMCTRL2 0x5b
#define PO1030_OUTFORMCTRL3 0x5c
#define PO1030_OUTFORMCTRL4 0x5d
#define PO1030_OUTFORMCTRL5 0x5e
#define PO1030_EDGE_ENH_OFF 0x5f
#define PO1030_EGA 0x60
#define PO1030_Cb_U_GAIN 0x63
#define PO1030_Cr_V_GAIN 0x64
#define PO1030_YCONTRAST 0x74
#define PO1030_YSATURATION 0x75
#define PO1030_HFLIP (1 << 7)
#define PO1030_VFLIP (1 << 6)
#define PO1030_HREF_ENABLE (1 << 6)
#define PO1030_RAW_RGB_BAYER 0x4
#define PO1030_FRAME_EQUAL (1 << 3)
#define PO1030_AUTO_SUBSAMPLING (1 << 4)
#define PO1030_WEIGHT_WIN_2X (1 << 3)
#define PO1030_SHUTTER_MODE (1 << 6)
#define PO1030_AUTO_SUBSAMPLING (1 << 4)
#define PO1030_FRAME_EQUAL (1 << 3)
#define PO1030_SENSOR_RESET (1 << 5)
/*****************************************************************************/
#define PO1030_GLOBAL_GAIN_DEFAULT 0x12
#define PO1030_EXPOSURE_DEFAULT 0x0085
#define PO1030_BLUE_GAIN_DEFAULT 0x36
#define PO1030_RED_GAIN_DEFAULT 0x36
#define PO1030_GREEN_GAIN_DEFAULT 0x40
/*****************************************************************************/
/* Kernel module parameters */
extern int force_sensor;
extern int dump_sensor;
int po1030_probe(struct sd *sd);
int po1030_init(struct sd *sd);
int po1030_start(struct sd *sd);
void po1030_disconnect(struct sd *sd);
static const struct m5602_sensor po1030 = {
.name = "PO1030",
.i2c_slave_id = 0xdc,
.i2c_regW = 1,
.probe = po1030_probe,
.init = po1030_init,
.start = po1030_start,
.disconnect = po1030_disconnect,
};
static const unsigned char preinit_po1030[][3] =
{
{BRIDGE, M5602_XB_MCU_CLK_DIV, 0x02},
{BRIDGE, M5602_XB_MCU_CLK_CTRL, 0xb0},
{BRIDGE, M5602_XB_SEN_CLK_DIV, 0x00},
{BRIDGE, M5602_XB_SEN_CLK_CTRL, 0xb0},
{BRIDGE, M5602_XB_ADC_CTRL, 0xc0},
{BRIDGE, M5602_XB_SENSOR_CTRL, 0x00},
{BRIDGE, M5602_XB_SENSOR_TYPE, 0x0c},
{BRIDGE, M5602_XB_ADC_CTRL, 0xc0},
{BRIDGE, M5602_XB_GPIO_DIR, 0x05},
{BRIDGE, M5602_XB_GPIO_DAT, 0x04},
{BRIDGE, M5602_XB_GPIO_EN_H, 0x06},
{BRIDGE, M5602_XB_GPIO_DIR_H, 0x06},
{BRIDGE, M5602_XB_GPIO_DAT_H, 0x02},
{SENSOR, PO1030_AUTOCTRL2, PO1030_SENSOR_RESET | (1 << 2)},
{BRIDGE, M5602_XB_SEN_CLK_DIV, 0x04},
{BRIDGE, M5602_XB_SEN_CLK_CTRL, 0xb0},
{BRIDGE, M5602_XB_SEN_CLK_DIV, 0x00},
{BRIDGE, M5602_XB_SEN_CLK_CTRL, 0xb0},
{BRIDGE, M5602_XB_SENSOR_TYPE, 0x0c},
{BRIDGE, M5602_XB_GPIO_DIR, 0x05},
{BRIDGE, M5602_XB_GPIO_DAT, 0x00}
};
static const unsigned char init_po1030[][3] =
{
{BRIDGE, M5602_XB_MCU_CLK_DIV, 0x02},
{BRIDGE, M5602_XB_MCU_CLK_CTRL, 0xb0},
{BRIDGE, M5602_XB_SEN_CLK_DIV, 0x00},
{BRIDGE, M5602_XB_SEN_CLK_CTRL, 0xb0},
{BRIDGE, M5602_XB_ADC_CTRL, 0xc0},
{BRIDGE, M5602_XB_SENSOR_CTRL, 0x00},
{BRIDGE, M5602_XB_SENSOR_TYPE, 0x0c},
{SENSOR, PO1030_AUTOCTRL2, PO1030_SENSOR_RESET | (1 << 2)},
{BRIDGE, M5602_XB_GPIO_DIR, 0x05},
{BRIDGE, M5602_XB_GPIO_DAT, 0x04},
{BRIDGE, M5602_XB_GPIO_EN_H, 0x06},
{BRIDGE, M5602_XB_GPIO_EN_L, 0x00},
{BRIDGE, M5602_XB_GPIO_DIR_H, 0x06},
{BRIDGE, M5602_XB_GPIO_DAT_H, 0x02},
{BRIDGE, M5602_XB_SEN_CLK_DIV, 0x04},
{BRIDGE, M5602_XB_SEN_CLK_CTRL, 0xb0},
{BRIDGE, M5602_XB_GPIO_DIR, 0x05},
{BRIDGE, M5602_XB_GPIO_DAT, 0x00},
{SENSOR, PO1030_AUTOCTRL2, 0x04},
{SENSOR, PO1030_OUTFORMCTRL2, PO1030_RAW_RGB_BAYER},
{SENSOR, PO1030_AUTOCTRL1, PO1030_WEIGHT_WIN_2X},
{SENSOR, PO1030_CONTROL2, 0x03},
{SENSOR, 0x21, 0x90},
{SENSOR, PO1030_YTARGET, 0x60},
{SENSOR, 0x59, 0x13},
{SENSOR, PO1030_OUTFORMCTRL1, PO1030_HREF_ENABLE},
{SENSOR, PO1030_EDGE_ENH_OFF, 0x00},
{SENSOR, PO1030_EGA, 0x80},
{SENSOR, 0x78, 0x14},
{SENSOR, 0x6f, 0x01},
{SENSOR, PO1030_GLOBALGAINMAX, 0x14},
{SENSOR, PO1030_Cb_U_GAIN, 0x38},
{SENSOR, PO1030_Cr_V_GAIN, 0x38},
{SENSOR, PO1030_CONTROL1, PO1030_SHUTTER_MODE |
PO1030_AUTO_SUBSAMPLING |
PO1030_FRAME_EQUAL},
{SENSOR, PO1030_GC0, 0x10},
{SENSOR, PO1030_GC1, 0x20},
{SENSOR, PO1030_GC2, 0x40},
{SENSOR, PO1030_GC3, 0x60},
{SENSOR, PO1030_GC4, 0x80},
{SENSOR, PO1030_GC5, 0xa0},
{SENSOR, PO1030_GC6, 0xc0},
{SENSOR, PO1030_GC7, 0xff},
/* Set the width to 751 */
{SENSOR, PO1030_FRAMEWIDTH_H, 0x02},
{SENSOR, PO1030_FRAMEWIDTH_L, 0xef},
/* Set the height to 540 */
{SENSOR, PO1030_FRAMEHEIGHT_H, 0x02},
{SENSOR, PO1030_FRAMEHEIGHT_L, 0x1c},
/* Set the x window to 1 */
{SENSOR, PO1030_WINDOWX_H, 0x00},
{SENSOR, PO1030_WINDOWX_L, 0x01},
/* Set the y window to 1 */
{SENSOR, PO1030_WINDOWY_H, 0x00},
{SENSOR, PO1030_WINDOWY_L, 0x01},
/* with a very low lighted environment increase the exposure but
* decrease the FPS (Frame Per Second) */
{BRIDGE, M5602_XB_SEN_CLK_DIV, 0x00},
{BRIDGE, M5602_XB_SEN_CLK_CTRL, 0xb0},
{BRIDGE, M5602_XB_GPIO_DIR, 0x05},
{BRIDGE, M5602_XB_GPIO_DAT, 0x00},
{BRIDGE, M5602_XB_GPIO_EN_H, 0x06},
{BRIDGE, M5602_XB_GPIO_EN_L, 0x00},
};
#endif
|