]>
Commit | Line | Data |
---|---|---|
11227fd1 | 1 | /* |
13a5e30c | 2 | * PS3 AV backend support. |
11227fd1 | 3 | * |
13a5e30c GL |
4 | * Copyright (C) 2007 Sony Computer Entertainment Inc. |
5 | * Copyright 2007 Sony Corp. | |
11227fd1 | 6 | * |
13a5e30c GL |
7 | * This program is free software; you can redistribute it and/or modify |
8 | * it under the terms of the GNU General Public License as published by | |
9 | * the Free Software Foundation; version 2 of the License. | |
11227fd1 | 10 | * |
13a5e30c GL |
11 | * This program is distributed in the hope that it will be useful, |
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
14 | * GNU General Public License for more details. | |
11227fd1 | 15 | * |
13a5e30c GL |
16 | * You should have received a copy of the GNU General Public License |
17 | * along with this program; if not, write to the Free Software | |
18 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
11227fd1 GU |
19 | */ |
20 | ||
13a5e30c | 21 | #include <linux/kernel.h> |
11227fd1 GU |
22 | #include <linux/module.h> |
23 | #include <linux/delay.h> | |
24 | #include <linux/notifier.h> | |
11227fd1 | 25 | #include <linux/ioctl.h> |
ef596c69 GU |
26 | |
27 | #include <asm/firmware.h> | |
11227fd1 GU |
28 | #include <asm/ps3av.h> |
29 | #include <asm/ps3.h> | |
30 | ||
31 | #include "vuart.h" | |
32 | ||
33 | #define BUFSIZE 4096 /* vuart buf size */ | |
34 | #define PS3AV_BUF_SIZE 512 /* max packet size */ | |
35 | ||
36 | static int timeout = 5000; /* in msec ( 5 sec ) */ | |
37 | module_param(timeout, int, 0644); | |
38 | ||
fffe52e8 | 39 | static struct ps3av { |
fffe52e8 GU |
40 | struct mutex mutex; |
41 | struct work_struct work; | |
42 | struct completion done; | |
43 | struct workqueue_struct *wq; | |
44 | int open_count; | |
13a5e30c | 45 | struct ps3_system_bus_device *dev; |
fffe52e8 GU |
46 | |
47 | int region; | |
48 | struct ps3av_pkt_av_get_hw_conf av_hw_conf; | |
49 | u32 av_port[PS3AV_AV_PORT_MAX + PS3AV_OPT_PORT_MAX]; | |
50 | u32 opt_port[PS3AV_OPT_PORT_MAX]; | |
51 | u32 head[PS3AV_HEAD_MAX]; | |
52 | u32 audio_port; | |
53 | int ps3av_mode; | |
54 | int ps3av_mode_old; | |
13a5e30c GL |
55 | union { |
56 | struct ps3av_reply_hdr reply_hdr; | |
57 | u8 raw[PS3AV_BUF_SIZE]; | |
58 | } recv_buf; | |
59 | void (*flip_ctl)(int on, void *data); | |
60 | void *flip_data; | |
61 | } *ps3av; | |
11227fd1 GU |
62 | |
63 | /* color space */ | |
64 | #define YUV444 PS3AV_CMD_VIDEO_CS_YUV444_8 | |
65 | #define RGB8 PS3AV_CMD_VIDEO_CS_RGB_8 | |
66 | /* format */ | |
67 | #define XRGB PS3AV_CMD_VIDEO_FMT_X8R8G8B8 | |
68 | /* aspect */ | |
69 | #define A_N PS3AV_CMD_AV_ASPECT_4_3 | |
70 | #define A_W PS3AV_CMD_AV_ASPECT_16_9 | |
71 | static const struct avset_video_mode { | |
72 | u32 cs; | |
73 | u32 fmt; | |
74 | u32 vid; | |
75 | u32 aspect; | |
76 | u32 x; | |
77 | u32 y; | |
78 | u32 interlace; | |
79 | u32 freq; | |
80 | } video_mode_table[] = { | |
81 | { 0, }, /* auto */ | |
82 | {YUV444, XRGB, PS3AV_CMD_VIDEO_VID_480I, A_N, 720, 480, 1, 60}, | |
83 | {YUV444, XRGB, PS3AV_CMD_VIDEO_VID_480P, A_N, 720, 480, 0, 60}, | |
84 | {YUV444, XRGB, PS3AV_CMD_VIDEO_VID_720P_60HZ, A_N, 1280, 720, 0, 60}, | |
85 | {YUV444, XRGB, PS3AV_CMD_VIDEO_VID_1080I_60HZ, A_W, 1920, 1080, 1, 60}, | |
86 | {YUV444, XRGB, PS3AV_CMD_VIDEO_VID_1080P_60HZ, A_W, 1920, 1080, 0, 60}, | |
87 | {YUV444, XRGB, PS3AV_CMD_VIDEO_VID_576I, A_N, 720, 576, 1, 50}, | |
88 | {YUV444, XRGB, PS3AV_CMD_VIDEO_VID_576P, A_N, 720, 576, 0, 50}, | |
89 | {YUV444, XRGB, PS3AV_CMD_VIDEO_VID_720P_50HZ, A_N, 1280, 720, 0, 50}, | |
90 | {YUV444, XRGB, PS3AV_CMD_VIDEO_VID_1080I_50HZ, A_W, 1920, 1080, 1, 50}, | |
91 | {YUV444, XRGB, PS3AV_CMD_VIDEO_VID_1080P_50HZ, A_W, 1920, 1080, 0, 50}, | |
92 | { RGB8, XRGB, PS3AV_CMD_VIDEO_VID_WXGA, A_W, 1280, 768, 0, 60}, | |
93 | { RGB8, XRGB, PS3AV_CMD_VIDEO_VID_SXGA, A_N, 1280, 1024, 0, 60}, | |
94 | { RGB8, XRGB, PS3AV_CMD_VIDEO_VID_WUXGA, A_W, 1920, 1200, 0, 60}, | |
95 | }; | |
96 | ||
97 | /* supported CIDs */ | |
98 | static u32 cmd_table[] = { | |
99 | /* init */ | |
100 | PS3AV_CID_AV_INIT, | |
101 | PS3AV_CID_AV_FIN, | |
102 | PS3AV_CID_VIDEO_INIT, | |
103 | PS3AV_CID_AUDIO_INIT, | |
104 | ||
105 | /* set */ | |
106 | PS3AV_CID_AV_ENABLE_EVENT, | |
107 | PS3AV_CID_AV_DISABLE_EVENT, | |
108 | ||
109 | PS3AV_CID_AV_VIDEO_CS, | |
110 | PS3AV_CID_AV_VIDEO_MUTE, | |
111 | PS3AV_CID_AV_VIDEO_DISABLE_SIG, | |
112 | PS3AV_CID_AV_AUDIO_PARAM, | |
113 | PS3AV_CID_AV_AUDIO_MUTE, | |
114 | PS3AV_CID_AV_HDMI_MODE, | |
115 | PS3AV_CID_AV_TV_MUTE, | |
116 | ||
117 | PS3AV_CID_VIDEO_MODE, | |
118 | PS3AV_CID_VIDEO_FORMAT, | |
119 | PS3AV_CID_VIDEO_PITCH, | |
120 | ||
121 | PS3AV_CID_AUDIO_MODE, | |
122 | PS3AV_CID_AUDIO_MUTE, | |
123 | PS3AV_CID_AUDIO_ACTIVE, | |
124 | PS3AV_CID_AUDIO_INACTIVE, | |
125 | PS3AV_CID_AVB_PARAM, | |
126 | ||
127 | /* get */ | |
128 | PS3AV_CID_AV_GET_HW_CONF, | |
129 | PS3AV_CID_AV_GET_MONITOR_INFO, | |
130 | ||
131 | /* event */ | |
132 | PS3AV_CID_EVENT_UNPLUGGED, | |
133 | PS3AV_CID_EVENT_PLUGGED, | |
134 | PS3AV_CID_EVENT_HDCP_DONE, | |
135 | PS3AV_CID_EVENT_HDCP_FAIL, | |
136 | PS3AV_CID_EVENT_HDCP_AUTH, | |
137 | PS3AV_CID_EVENT_HDCP_ERROR, | |
138 | ||
139 | 0 | |
140 | }; | |
141 | ||
142 | #define PS3AV_EVENT_CMD_MASK 0x10000000 | |
143 | #define PS3AV_EVENT_ID_MASK 0x0000ffff | |
144 | #define PS3AV_CID_MASK 0xffffffff | |
145 | #define PS3AV_REPLY_BIT 0x80000000 | |
146 | ||
147 | #define ps3av_event_get_port_id(cid) ((cid >> 16) & 0xff) | |
148 | ||
149 | static u32 *ps3av_search_cmd_table(u32 cid, u32 mask) | |
150 | { | |
151 | u32 *table; | |
152 | int i; | |
153 | ||
154 | table = cmd_table; | |
155 | for (i = 0;; table++, i++) { | |
156 | if ((*table & mask) == (cid & mask)) | |
157 | break; | |
158 | if (*table == 0) | |
159 | return NULL; | |
160 | } | |
161 | return table; | |
162 | } | |
163 | ||
164 | static int ps3av_parse_event_packet(const struct ps3av_reply_hdr *hdr) | |
165 | { | |
166 | u32 *table; | |
167 | ||
168 | if (hdr->cid & PS3AV_EVENT_CMD_MASK) { | |
169 | table = ps3av_search_cmd_table(hdr->cid, PS3AV_EVENT_CMD_MASK); | |
170 | if (table) | |
13a5e30c | 171 | dev_dbg(&ps3av->dev->core, |
11227fd1 GU |
172 | "recv event packet cid:%08x port:0x%x size:%d\n", |
173 | hdr->cid, ps3av_event_get_port_id(hdr->cid), | |
174 | hdr->size); | |
175 | else | |
176 | printk(KERN_ERR | |
177 | "%s: failed event packet, cid:%08x size:%d\n", | |
253f04e7 | 178 | __func__, hdr->cid, hdr->size); |
11227fd1 GU |
179 | return 1; /* receive event packet */ |
180 | } | |
181 | return 0; | |
182 | } | |
183 | ||
13a5e30c GL |
184 | |
185 | #define POLLING_INTERVAL 25 /* in msec */ | |
186 | ||
187 | static int ps3av_vuart_write(struct ps3_system_bus_device *dev, | |
188 | const void *buf, unsigned long size) | |
189 | { | |
190 | int error; | |
191 | dev_dbg(&dev->core, " -> %s:%d\n", __func__, __LINE__); | |
192 | error = ps3_vuart_write(dev, buf, size); | |
193 | dev_dbg(&dev->core, " <- %s:%d\n", __func__, __LINE__); | |
194 | return error ? error : size; | |
195 | } | |
196 | ||
197 | static int ps3av_vuart_read(struct ps3_system_bus_device *dev, void *buf, | |
198 | unsigned long size, int timeout) | |
199 | { | |
200 | int error; | |
201 | int loopcnt = 0; | |
202 | ||
203 | dev_dbg(&dev->core, " -> %s:%d\n", __func__, __LINE__); | |
204 | timeout = (timeout + POLLING_INTERVAL - 1) / POLLING_INTERVAL; | |
205 | while (loopcnt++ <= timeout) { | |
206 | error = ps3_vuart_read(dev, buf, size); | |
207 | if (!error) | |
208 | return size; | |
209 | if (error != -EAGAIN) { | |
210 | printk(KERN_ERR "%s: ps3_vuart_read failed %d\n", | |
211 | __func__, error); | |
212 | return error; | |
213 | } | |
214 | msleep(POLLING_INTERVAL); | |
215 | } | |
216 | return -EWOULDBLOCK; | |
217 | } | |
218 | ||
11227fd1 GU |
219 | static int ps3av_send_cmd_pkt(const struct ps3av_send_hdr *send_buf, |
220 | struct ps3av_reply_hdr *recv_buf, int write_len, | |
221 | int read_len) | |
222 | { | |
223 | int res; | |
224 | u32 cmd; | |
225 | int event; | |
226 | ||
13a5e30c | 227 | if (!ps3av) |
11227fd1 GU |
228 | return -ENODEV; |
229 | ||
230 | /* send pkt */ | |
13a5e30c | 231 | res = ps3av_vuart_write(ps3av->dev, send_buf, write_len); |
11227fd1 | 232 | if (res < 0) { |
13a5e30c | 233 | dev_dbg(&ps3av->dev->core, |
11227fd1 | 234 | "%s: ps3av_vuart_write() failed (result=%d)\n", |
253f04e7 | 235 | __func__, res); |
11227fd1 GU |
236 | return res; |
237 | } | |
238 | ||
239 | /* recv pkt */ | |
240 | cmd = send_buf->cid; | |
241 | do { | |
242 | /* read header */ | |
13a5e30c | 243 | res = ps3av_vuart_read(ps3av->dev, recv_buf, PS3AV_HDR_SIZE, |
11227fd1 GU |
244 | timeout); |
245 | if (res != PS3AV_HDR_SIZE) { | |
13a5e30c | 246 | dev_dbg(&ps3av->dev->core, |
11227fd1 | 247 | "%s: ps3av_vuart_read() failed (result=%d)\n", |
253f04e7 | 248 | __func__, res); |
11227fd1 GU |
249 | return res; |
250 | } | |
251 | ||
252 | /* read body */ | |
13a5e30c | 253 | res = ps3av_vuart_read(ps3av->dev, &recv_buf->cid, |
11227fd1 GU |
254 | recv_buf->size, timeout); |
255 | if (res < 0) { | |
13a5e30c | 256 | dev_dbg(&ps3av->dev->core, |
11227fd1 | 257 | "%s: ps3av_vuart_read() failed (result=%d)\n", |
253f04e7 | 258 | __func__, res); |
11227fd1 GU |
259 | return res; |
260 | } | |
261 | res += PS3AV_HDR_SIZE; /* total len */ | |
262 | event = ps3av_parse_event_packet(recv_buf); | |
263 | /* ret > 0 event packet */ | |
264 | } while (event); | |
265 | ||
266 | if ((cmd | PS3AV_REPLY_BIT) != recv_buf->cid) { | |
13a5e30c | 267 | dev_dbg(&ps3av->dev->core, "%s: reply err (result=%x)\n", |
253f04e7 | 268 | __func__, recv_buf->cid); |
11227fd1 GU |
269 | return -EINVAL; |
270 | } | |
271 | ||
272 | return 0; | |
273 | } | |
274 | ||
275 | static int ps3av_process_reply_packet(struct ps3av_send_hdr *cmd_buf, | |
276 | const struct ps3av_reply_hdr *recv_buf, | |
277 | int user_buf_size) | |
278 | { | |
279 | int return_len; | |
280 | ||
281 | if (recv_buf->version != PS3AV_VERSION) { | |
13a5e30c | 282 | dev_dbg(&ps3av->dev->core, "reply_packet invalid version:%x\n", |
11227fd1 GU |
283 | recv_buf->version); |
284 | return -EFAULT; | |
285 | } | |
286 | return_len = recv_buf->size + PS3AV_HDR_SIZE; | |
287 | if (return_len > user_buf_size) | |
288 | return_len = user_buf_size; | |
289 | memcpy(cmd_buf, recv_buf, return_len); | |
290 | return 0; /* success */ | |
291 | } | |
292 | ||
293 | void ps3av_set_hdr(u32 cid, u16 size, struct ps3av_send_hdr *hdr) | |
294 | { | |
295 | hdr->version = PS3AV_VERSION; | |
296 | hdr->size = size - PS3AV_HDR_SIZE; | |
297 | hdr->cid = cid; | |
298 | } | |
299 | ||
300 | int ps3av_do_pkt(u32 cid, u16 send_len, size_t usr_buf_size, | |
301 | struct ps3av_send_hdr *buf) | |
302 | { | |
303 | int res = 0; | |
11227fd1 GU |
304 | u32 *table; |
305 | ||
13a5e30c | 306 | BUG_ON(!ps3av); |
11227fd1 | 307 | |
13a5e30c | 308 | mutex_lock(&ps3av->mutex); |
11227fd1 GU |
309 | |
310 | table = ps3av_search_cmd_table(cid, PS3AV_CID_MASK); | |
311 | BUG_ON(!table); | |
312 | BUG_ON(send_len < PS3AV_HDR_SIZE); | |
313 | BUG_ON(usr_buf_size < send_len); | |
314 | BUG_ON(usr_buf_size > PS3AV_BUF_SIZE); | |
315 | ||
316 | /* create header */ | |
317 | ps3av_set_hdr(cid, send_len, buf); | |
318 | ||
319 | /* send packet via vuart */ | |
13a5e30c | 320 | res = ps3av_send_cmd_pkt(buf, &ps3av->recv_buf.reply_hdr, send_len, |
11227fd1 GU |
321 | usr_buf_size); |
322 | if (res < 0) { | |
323 | printk(KERN_ERR | |
324 | "%s: ps3av_send_cmd_pkt() failed (result=%d)\n", | |
253f04e7 | 325 | __func__, res); |
11227fd1 GU |
326 | goto err; |
327 | } | |
328 | ||
329 | /* process reply packet */ | |
13a5e30c | 330 | res = ps3av_process_reply_packet(buf, &ps3av->recv_buf.reply_hdr, |
11227fd1 GU |
331 | usr_buf_size); |
332 | if (res < 0) { | |
333 | printk(KERN_ERR "%s: put_return_status() failed (result=%d)\n", | |
253f04e7 | 334 | __func__, res); |
11227fd1 GU |
335 | goto err; |
336 | } | |
337 | ||
13a5e30c | 338 | mutex_unlock(&ps3av->mutex); |
11227fd1 GU |
339 | return 0; |
340 | ||
341 | err: | |
13a5e30c | 342 | mutex_unlock(&ps3av->mutex); |
253f04e7 | 343 | printk(KERN_ERR "%s: failed cid:%x res:%d\n", __func__, cid, res); |
11227fd1 GU |
344 | return res; |
345 | } | |
346 | ||
347 | static int ps3av_set_av_video_mute(u32 mute) | |
348 | { | |
349 | int i, num_of_av_port, res; | |
350 | ||
13a5e30c GL |
351 | num_of_av_port = ps3av->av_hw_conf.num_of_hdmi + |
352 | ps3av->av_hw_conf.num_of_avmulti; | |
11227fd1 GU |
353 | /* video mute on */ |
354 | for (i = 0; i < num_of_av_port; i++) { | |
13a5e30c | 355 | res = ps3av_cmd_av_video_mute(1, &ps3av->av_port[i], mute); |
11227fd1 GU |
356 | if (res < 0) |
357 | return -1; | |
358 | } | |
359 | ||
360 | return 0; | |
361 | } | |
362 | ||
363 | static int ps3av_set_video_disable_sig(void) | |
364 | { | |
365 | int i, num_of_hdmi_port, num_of_av_port, res; | |
366 | ||
13a5e30c GL |
367 | num_of_hdmi_port = ps3av->av_hw_conf.num_of_hdmi; |
368 | num_of_av_port = ps3av->av_hw_conf.num_of_hdmi + | |
369 | ps3av->av_hw_conf.num_of_avmulti; | |
11227fd1 GU |
370 | |
371 | /* tv mute */ | |
372 | for (i = 0; i < num_of_hdmi_port; i++) { | |
13a5e30c | 373 | res = ps3av_cmd_av_tv_mute(ps3av->av_port[i], |
11227fd1 GU |
374 | PS3AV_CMD_MUTE_ON); |
375 | if (res < 0) | |
376 | return -1; | |
377 | } | |
378 | msleep(100); | |
379 | ||
380 | /* video mute on */ | |
381 | for (i = 0; i < num_of_av_port; i++) { | |
13a5e30c | 382 | res = ps3av_cmd_av_video_disable_sig(ps3av->av_port[i]); |
11227fd1 GU |
383 | if (res < 0) |
384 | return -1; | |
385 | if (i < num_of_hdmi_port) { | |
13a5e30c | 386 | res = ps3av_cmd_av_tv_mute(ps3av->av_port[i], |
11227fd1 GU |
387 | PS3AV_CMD_MUTE_OFF); |
388 | if (res < 0) | |
389 | return -1; | |
390 | } | |
391 | } | |
392 | msleep(300); | |
393 | ||
394 | return 0; | |
395 | } | |
396 | ||
397 | static int ps3av_set_audio_mute(u32 mute) | |
398 | { | |
399 | int i, num_of_av_port, num_of_opt_port, res; | |
400 | ||
13a5e30c GL |
401 | num_of_av_port = ps3av->av_hw_conf.num_of_hdmi + |
402 | ps3av->av_hw_conf.num_of_avmulti; | |
403 | num_of_opt_port = ps3av->av_hw_conf.num_of_spdif; | |
11227fd1 GU |
404 | |
405 | for (i = 0; i < num_of_av_port; i++) { | |
13a5e30c | 406 | res = ps3av_cmd_av_audio_mute(1, &ps3av->av_port[i], mute); |
11227fd1 GU |
407 | if (res < 0) |
408 | return -1; | |
409 | } | |
410 | for (i = 0; i < num_of_opt_port; i++) { | |
13a5e30c | 411 | res = ps3av_cmd_audio_mute(1, &ps3av->opt_port[i], mute); |
11227fd1 GU |
412 | if (res < 0) |
413 | return -1; | |
414 | } | |
415 | ||
416 | return 0; | |
417 | } | |
418 | ||
419 | int ps3av_set_audio_mode(u32 ch, u32 fs, u32 word_bits, u32 format, u32 source) | |
420 | { | |
421 | struct ps3av_pkt_avb_param avb_param; | |
422 | int i, num_of_audio, vid, res; | |
423 | struct ps3av_pkt_audio_mode audio_mode; | |
424 | u32 len = 0; | |
425 | ||
13a5e30c GL |
426 | num_of_audio = ps3av->av_hw_conf.num_of_hdmi + |
427 | ps3av->av_hw_conf.num_of_avmulti + | |
428 | ps3av->av_hw_conf.num_of_spdif; | |
11227fd1 GU |
429 | |
430 | avb_param.num_of_video_pkt = 0; | |
431 | avb_param.num_of_audio_pkt = PS3AV_AVB_NUM_AUDIO; /* always 0 */ | |
432 | avb_param.num_of_av_video_pkt = 0; | |
13a5e30c | 433 | avb_param.num_of_av_audio_pkt = ps3av->av_hw_conf.num_of_hdmi; |
11227fd1 | 434 | |
13a5e30c | 435 | vid = video_mode_table[ps3av->ps3av_mode].vid; |
11227fd1 GU |
436 | |
437 | /* audio mute */ | |
438 | ps3av_set_audio_mute(PS3AV_CMD_MUTE_ON); | |
439 | ||
440 | /* audio inactive */ | |
13a5e30c | 441 | res = ps3av_cmd_audio_active(0, ps3av->audio_port); |
11227fd1 | 442 | if (res < 0) |
13a5e30c | 443 | dev_dbg(&ps3av->dev->core, |
11227fd1 GU |
444 | "ps3av_cmd_audio_active OFF failed\n"); |
445 | ||
446 | /* audio_pkt */ | |
447 | for (i = 0; i < num_of_audio; i++) { | |
13a5e30c GL |
448 | ps3av_cmd_set_audio_mode(&audio_mode, ps3av->av_port[i], ch, |
449 | fs, word_bits, format, source); | |
450 | if (i < ps3av->av_hw_conf.num_of_hdmi) { | |
11227fd1 GU |
451 | /* hdmi only */ |
452 | len += ps3av_cmd_set_av_audio_param(&avb_param.buf[len], | |
13a5e30c | 453 | ps3av->av_port[i], |
11227fd1 GU |
454 | &audio_mode, vid); |
455 | } | |
456 | /* audio_mode pkt should be sent separately */ | |
457 | res = ps3av_cmd_audio_mode(&audio_mode); | |
458 | if (res < 0) | |
13a5e30c | 459 | dev_dbg(&ps3av->dev->core, |
11227fd1 GU |
460 | "ps3av_cmd_audio_mode failed, port:%x\n", i); |
461 | } | |
462 | ||
463 | /* send command using avb pkt */ | |
464 | len += offsetof(struct ps3av_pkt_avb_param, buf); | |
465 | res = ps3av_cmd_avb_param(&avb_param, len); | |
466 | if (res < 0) | |
13a5e30c | 467 | dev_dbg(&ps3av->dev->core, "ps3av_cmd_avb_param failed\n"); |
11227fd1 GU |
468 | |
469 | /* audio mute */ | |
470 | ps3av_set_audio_mute(PS3AV_CMD_MUTE_OFF); | |
471 | ||
472 | /* audio active */ | |
13a5e30c | 473 | res = ps3av_cmd_audio_active(1, ps3av->audio_port); |
11227fd1 | 474 | if (res < 0) |
13a5e30c GL |
475 | dev_dbg(&ps3av->dev->core, |
476 | "ps3av_cmd_audio_active ON failed\n"); | |
11227fd1 GU |
477 | |
478 | return 0; | |
479 | } | |
480 | ||
481 | EXPORT_SYMBOL_GPL(ps3av_set_audio_mode); | |
482 | ||
483 | static int ps3av_set_videomode(void) | |
484 | { | |
485 | /* av video mute */ | |
486 | ps3av_set_av_video_mute(PS3AV_CMD_MUTE_ON); | |
487 | ||
488 | /* wake up ps3avd to do the actual video mode setting */ | |
13a5e30c | 489 | queue_work(ps3av->wq, &ps3av->work); |
11227fd1 GU |
490 | |
491 | return 0; | |
492 | } | |
493 | ||
8ca0bf75 | 494 | static void ps3av_set_videomode_packet(u32 id) |
11227fd1 GU |
495 | { |
496 | struct ps3av_pkt_avb_param avb_param; | |
8ca0bf75 | 497 | unsigned int i; |
11227fd1 GU |
498 | u32 len = 0, av_video_cs; |
499 | const struct avset_video_mode *video_mode; | |
500 | int res; | |
501 | ||
502 | video_mode = &video_mode_table[id & PS3AV_MODE_MASK]; | |
503 | ||
504 | avb_param.num_of_video_pkt = PS3AV_AVB_NUM_VIDEO; /* num of head */ | |
505 | avb_param.num_of_audio_pkt = 0; | |
13a5e30c GL |
506 | avb_param.num_of_av_video_pkt = ps3av->av_hw_conf.num_of_hdmi + |
507 | ps3av->av_hw_conf.num_of_avmulti; | |
11227fd1 GU |
508 | avb_param.num_of_av_audio_pkt = 0; |
509 | ||
11227fd1 GU |
510 | /* video_pkt */ |
511 | for (i = 0; i < avb_param.num_of_video_pkt; i++) | |
512 | len += ps3av_cmd_set_video_mode(&avb_param.buf[len], | |
13a5e30c | 513 | ps3av->head[i], video_mode->vid, |
11227fd1 GU |
514 | video_mode->fmt, id); |
515 | /* av_video_pkt */ | |
516 | for (i = 0; i < avb_param.num_of_av_video_pkt; i++) { | |
517 | if (id & PS3AV_MODE_DVI || id & PS3AV_MODE_RGB) | |
518 | av_video_cs = RGB8; | |
519 | else | |
520 | av_video_cs = video_mode->cs; | |
521 | #ifndef PS3AV_HDMI_YUV | |
13a5e30c GL |
522 | if (ps3av->av_port[i] == PS3AV_CMD_AVPORT_HDMI_0 || |
523 | ps3av->av_port[i] == PS3AV_CMD_AVPORT_HDMI_1) | |
11227fd1 GU |
524 | av_video_cs = RGB8; /* use RGB for HDMI */ |
525 | #endif | |
526 | len += ps3av_cmd_set_av_video_cs(&avb_param.buf[len], | |
13a5e30c | 527 | ps3av->av_port[i], |
11227fd1 GU |
528 | video_mode->vid, av_video_cs, |
529 | video_mode->aspect, id); | |
530 | } | |
531 | /* send command using avb pkt */ | |
532 | len += offsetof(struct ps3av_pkt_avb_param, buf); | |
533 | res = ps3av_cmd_avb_param(&avb_param, len); | |
534 | if (res == PS3AV_STATUS_NO_SYNC_HEAD) | |
535 | printk(KERN_WARNING | |
536 | "%s: Command failed. Please try your request again. \n", | |
253f04e7 | 537 | __func__); |
11227fd1 | 538 | else if (res) |
13a5e30c | 539 | dev_dbg(&ps3av->dev->core, "ps3av_cmd_avb_param failed\n"); |
8ca0bf75 MK |
540 | } |
541 | ||
542 | static void ps3av_set_videomode_cont(u32 id, u32 old_id) | |
543 | { | |
544 | static int vesa = 0; | |
545 | int res; | |
546 | ||
547 | /* video signal off */ | |
548 | ps3av_set_video_disable_sig(); | |
549 | ||
550 | /* | |
551 | * AV backend needs non-VESA mode setting at least one time | |
552 | * when VESA mode is used. | |
553 | */ | |
554 | if (vesa == 0 && (id & PS3AV_MODE_MASK) >= 11) { | |
555 | /* vesa mode */ | |
556 | ps3av_set_videomode_packet(2); /* 480P */ | |
557 | } | |
558 | vesa = 1; | |
559 | ||
560 | /* Retail PS3 product doesn't support this */ | |
561 | if (id & PS3AV_MODE_HDCP_OFF) { | |
562 | res = ps3av_cmd_av_hdmi_mode(PS3AV_CMD_AV_HDMI_HDCP_OFF); | |
563 | if (res == PS3AV_STATUS_UNSUPPORTED_HDMI_MODE) | |
564 | dev_dbg(&ps3av->dev->core, "Not supported\n"); | |
565 | else if (res) | |
566 | dev_dbg(&ps3av->dev->core, | |
567 | "ps3av_cmd_av_hdmi_mode failed\n"); | |
568 | } else if (old_id & PS3AV_MODE_HDCP_OFF) { | |
569 | res = ps3av_cmd_av_hdmi_mode(PS3AV_CMD_AV_HDMI_MODE_NORMAL); | |
570 | if (res < 0 && res != PS3AV_STATUS_UNSUPPORTED_HDMI_MODE) | |
571 | dev_dbg(&ps3av->dev->core, | |
572 | "ps3av_cmd_av_hdmi_mode failed\n"); | |
573 | } | |
574 | ||
575 | ps3av_set_videomode_packet(id); | |
11227fd1 GU |
576 | |
577 | msleep(1500); | |
578 | /* av video mute */ | |
579 | ps3av_set_av_video_mute(PS3AV_CMD_MUTE_OFF); | |
580 | } | |
581 | ||
5caf5db8 | 582 | static void ps3avd(struct work_struct *work) |
11227fd1 | 583 | { |
13a5e30c GL |
584 | ps3av_set_videomode_cont(ps3av->ps3av_mode, ps3av->ps3av_mode_old); |
585 | complete(&ps3av->done); | |
11227fd1 GU |
586 | } |
587 | ||
fd562112 GU |
588 | #define SHIFT_50 0 |
589 | #define SHIFT_60 4 | |
590 | #define SHIFT_VESA 8 | |
591 | ||
592 | static const struct { | |
593 | unsigned mask : 19; | |
594 | unsigned id : 4; | |
595 | } ps3av_preferred_modes[] = { | |
596 | { .mask = PS3AV_RESBIT_WUXGA << SHIFT_VESA, .id = 13 }, | |
597 | { .mask = PS3AV_RESBIT_1920x1080P << SHIFT_60, .id = 5 }, | |
598 | { .mask = PS3AV_RESBIT_1920x1080P << SHIFT_50, .id = 10 }, | |
599 | { .mask = PS3AV_RESBIT_1920x1080I << SHIFT_60, .id = 4 }, | |
600 | { .mask = PS3AV_RESBIT_1920x1080I << SHIFT_50, .id = 9 }, | |
601 | { .mask = PS3AV_RESBIT_SXGA << SHIFT_VESA, .id = 12 }, | |
602 | { .mask = PS3AV_RESBIT_WXGA << SHIFT_VESA, .id = 11 }, | |
603 | { .mask = PS3AV_RESBIT_1280x720P << SHIFT_60, .id = 3 }, | |
604 | { .mask = PS3AV_RESBIT_1280x720P << SHIFT_50, .id = 8 }, | |
605 | { .mask = PS3AV_RESBIT_720x480P << SHIFT_60, .id = 2 }, | |
606 | { .mask = PS3AV_RESBIT_720x576P << SHIFT_50, .id = 7 }, | |
607 | }; | |
608 | ||
609 | static int ps3av_resbit2id(u32 res_50, u32 res_60, u32 res_vesa) | |
11227fd1 | 610 | { |
fd562112 GU |
611 | unsigned int i; |
612 | u32 res_all; | |
613 | ||
614 | /* | |
615 | * We mask off the resolution bits we care about and combine the | |
616 | * results in one bitfield, so make sure there's no overlap | |
617 | */ | |
618 | BUILD_BUG_ON(PS3AV_RES_MASK_50 << SHIFT_50 & | |
619 | PS3AV_RES_MASK_60 << SHIFT_60); | |
620 | BUILD_BUG_ON(PS3AV_RES_MASK_50 << SHIFT_50 & | |
621 | PS3AV_RES_MASK_VESA << SHIFT_VESA); | |
622 | BUILD_BUG_ON(PS3AV_RES_MASK_60 << SHIFT_60 & | |
623 | PS3AV_RES_MASK_VESA << SHIFT_VESA); | |
624 | res_all = (res_50 & PS3AV_RES_MASK_50) << SHIFT_50 | | |
625 | (res_60 & PS3AV_RES_MASK_60) << SHIFT_60 | | |
626 | (res_vesa & PS3AV_RES_MASK_VESA) << SHIFT_VESA; | |
627 | ||
628 | if (!res_all) | |
629 | return 0; | |
630 | ||
631 | for (i = 0; i < ARRAY_SIZE(ps3av_preferred_modes); i++) | |
632 | if (res_all & ps3av_preferred_modes[i].mask) | |
633 | return ps3av_preferred_modes[i].id; | |
634 | ||
635 | return 0; | |
11227fd1 GU |
636 | } |
637 | ||
71a27fec | 638 | static int ps3av_hdmi_get_id(struct ps3av_info_monitor *info) |
11227fd1 | 639 | { |
71a27fec | 640 | int id; |
11227fd1 | 641 | |
11227fd1 | 642 | /* check native resolution */ |
fd562112 GU |
643 | id = ps3av_resbit2id(info->res_50.native, info->res_60.native, |
644 | info->res_vesa.native); | |
645 | if (id) { | |
646 | pr_debug("%s: Using native mode %d\n", __func__, id); | |
71a27fec | 647 | return id; |
11227fd1 GU |
648 | } |
649 | ||
fd562112 GU |
650 | /* check supported resolutions */ |
651 | id = ps3av_resbit2id(info->res_50.res_bits, info->res_60.res_bits, | |
652 | info->res_vesa.res_bits); | |
653 | if (id) { | |
654 | pr_debug("%s: Using supported mode %d\n", __func__, id); | |
71a27fec | 655 | return id; |
11227fd1 GU |
656 | } |
657 | ||
13a5e30c | 658 | if (ps3av->region & PS3AV_REGION_60) |
71a27fec | 659 | id = PS3AV_DEFAULT_HDMI_MODE_ID_REG_60; |
11227fd1 | 660 | else |
71a27fec | 661 | id = PS3AV_DEFAULT_HDMI_MODE_ID_REG_50; |
fd562112 | 662 | pr_debug("%s: Using default mode %d\n", __func__, id); |
71a27fec | 663 | return id; |
11227fd1 GU |
664 | } |
665 | ||
eea820ab GU |
666 | static void ps3av_monitor_info_dump(const struct ps3av_pkt_av_get_monitor_info *monitor_info) |
667 | { | |
668 | const struct ps3av_info_monitor *info = &monitor_info->info; | |
669 | const struct ps3av_info_audio *audio = info->audio; | |
670 | char id[sizeof(info->monitor_id)*3+1]; | |
671 | int i; | |
672 | ||
673 | pr_debug("Monitor Info: size %u\n", monitor_info->send_hdr.size); | |
674 | ||
675 | pr_debug("avport: %02x\n", info->avport); | |
676 | for (i = 0; i < sizeof(info->monitor_id); i++) | |
677 | sprintf(&id[i*3], " %02x", info->monitor_id[i]); | |
678 | pr_debug("monitor_id: %s\n", id); | |
679 | pr_debug("monitor_type: %02x\n", info->monitor_type); | |
680 | pr_debug("monitor_name: %.*s\n", (int)sizeof(info->monitor_name), | |
681 | info->monitor_name); | |
682 | ||
683 | /* resolution */ | |
684 | pr_debug("resolution_60: bits: %08x native: %08x\n", | |
685 | info->res_60.res_bits, info->res_60.native); | |
686 | pr_debug("resolution_50: bits: %08x native: %08x\n", | |
687 | info->res_50.res_bits, info->res_50.native); | |
688 | pr_debug("resolution_other: bits: %08x native: %08x\n", | |
689 | info->res_other.res_bits, info->res_other.native); | |
690 | pr_debug("resolution_vesa: bits: %08x native: %08x\n", | |
691 | info->res_vesa.res_bits, info->res_vesa.native); | |
692 | ||
693 | /* color space */ | |
694 | pr_debug("color space rgb: %02x\n", info->cs.rgb); | |
695 | pr_debug("color space yuv444: %02x\n", info->cs.yuv444); | |
696 | pr_debug("color space yuv422: %02x\n", info->cs.yuv422); | |
697 | ||
698 | /* color info */ | |
699 | pr_debug("color info red: X %04x Y %04x\n", info->color.red_x, | |
700 | info->color.red_y); | |
701 | pr_debug("color info green: X %04x Y %04x\n", info->color.green_x, | |
702 | info->color.green_y); | |
703 | pr_debug("color info blue: X %04x Y %04x\n", info->color.blue_x, | |
704 | info->color.blue_y); | |
705 | pr_debug("color info white: X %04x Y %04x\n", info->color.white_x, | |
706 | info->color.white_y); | |
707 | pr_debug("color info gamma: %08x\n", info->color.gamma); | |
708 | ||
709 | /* other info */ | |
710 | pr_debug("supported_AI: %02x\n", info->supported_ai); | |
711 | pr_debug("speaker_info: %02x\n", info->speaker_info); | |
712 | pr_debug("num of audio: %02x\n", info->num_of_audio_block); | |
713 | ||
714 | /* audio block */ | |
715 | for (i = 0; i < info->num_of_audio_block; i++) { | |
716 | pr_debug("audio[%d] type: %02x max_ch: %02x fs: %02x sbit: " | |
717 | "%02x\n", | |
718 | i, audio->type, audio->max_num_of_ch, audio->fs, | |
719 | audio->sbit); | |
720 | audio++; | |
721 | } | |
722 | } | |
723 | ||
11227fd1 GU |
724 | static int ps3av_auto_videomode(struct ps3av_pkt_av_get_hw_conf *av_hw_conf, |
725 | int boot) | |
726 | { | |
71a27fec | 727 | int i, res, id = 0, dvi = 0, rgb = 0; |
11227fd1 GU |
728 | struct ps3av_pkt_av_get_monitor_info monitor_info; |
729 | struct ps3av_info_monitor *info; | |
730 | ||
71a27fec | 731 | /* get mode id for hdmi */ |
101aa56d | 732 | for (i = 0; i < av_hw_conf->num_of_hdmi && !id; i++) { |
11227fd1 GU |
733 | res = ps3av_cmd_video_get_monitor_info(&monitor_info, |
734 | PS3AV_CMD_AVPORT_HDMI_0 + | |
735 | i); | |
736 | if (res < 0) | |
737 | return -1; | |
738 | ||
eea820ab | 739 | ps3av_monitor_info_dump(&monitor_info); |
101aa56d | 740 | |
11227fd1 | 741 | info = &monitor_info.info; |
101aa56d GU |
742 | switch (info->monitor_type) { |
743 | case PS3AV_MONITOR_TYPE_DVI: | |
11227fd1 | 744 | dvi = PS3AV_MODE_DVI; |
101aa56d GU |
745 | /* fall through */ |
746 | case PS3AV_MONITOR_TYPE_HDMI: | |
747 | id = ps3av_hdmi_get_id(info); | |
11227fd1 GU |
748 | break; |
749 | } | |
750 | } | |
751 | ||
101aa56d | 752 | if (!id) { |
11227fd1 | 753 | /* no HDMI interface or HDMI is off */ |
13a5e30c | 754 | if (ps3av->region & PS3AV_REGION_60) |
71a27fec | 755 | id = PS3AV_DEFAULT_AVMULTI_MODE_ID_REG_60; |
11227fd1 | 756 | else |
71a27fec | 757 | id = PS3AV_DEFAULT_AVMULTI_MODE_ID_REG_50; |
13a5e30c | 758 | if (ps3av->region & PS3AV_REGION_RGB) |
11227fd1 | 759 | rgb = PS3AV_MODE_RGB; |
fd562112 | 760 | pr_debug("%s: Using avmulti mode %d\n", __func__, id); |
11227fd1 | 761 | } else if (boot) { |
71a27fec | 762 | /* HDMI: using DEFAULT HDMI_MODE_ID while booting up */ |
11227fd1 | 763 | info = &monitor_info.info; |
13a5e30c | 764 | if (ps3av->region & PS3AV_REGION_60) { |
11227fd1 | 765 | if (info->res_60.res_bits & PS3AV_RESBIT_720x480P) |
71a27fec | 766 | id = PS3AV_DEFAULT_HDMI_MODE_ID_REG_60; |
11227fd1 | 767 | else if (info->res_50.res_bits & PS3AV_RESBIT_720x576P) |
71a27fec | 768 | id = PS3AV_DEFAULT_HDMI_MODE_ID_REG_50; |
11227fd1 GU |
769 | else { |
770 | /* default */ | |
71a27fec | 771 | id = PS3AV_DEFAULT_HDMI_MODE_ID_REG_60; |
11227fd1 GU |
772 | } |
773 | } else { | |
774 | if (info->res_50.res_bits & PS3AV_RESBIT_720x576P) | |
71a27fec | 775 | id = PS3AV_DEFAULT_HDMI_MODE_ID_REG_50; |
11227fd1 | 776 | else if (info->res_60.res_bits & PS3AV_RESBIT_720x480P) |
71a27fec | 777 | id = PS3AV_DEFAULT_HDMI_MODE_ID_REG_60; |
11227fd1 GU |
778 | else { |
779 | /* default */ | |
71a27fec | 780 | id = PS3AV_DEFAULT_HDMI_MODE_ID_REG_50; |
11227fd1 GU |
781 | } |
782 | } | |
783 | } | |
784 | ||
71a27fec | 785 | return id | dvi | rgb; |
11227fd1 GU |
786 | } |
787 | ||
788 | static int ps3av_get_hw_conf(struct ps3av *ps3av) | |
789 | { | |
790 | int i, j, k, res; | |
eea820ab | 791 | const struct ps3av_pkt_av_get_hw_conf *hw_conf; |
11227fd1 GU |
792 | |
793 | /* get av_hw_conf */ | |
794 | res = ps3av_cmd_av_get_hw_conf(&ps3av->av_hw_conf); | |
795 | if (res < 0) | |
796 | return -1; | |
797 | ||
eea820ab GU |
798 | hw_conf = &ps3av->av_hw_conf; |
799 | pr_debug("av_h_conf: num of hdmi: %u\n", hw_conf->num_of_hdmi); | |
800 | pr_debug("av_h_conf: num of avmulti: %u\n", hw_conf->num_of_avmulti); | |
801 | pr_debug("av_h_conf: num of spdif: %u\n", hw_conf->num_of_spdif); | |
11227fd1 GU |
802 | |
803 | for (i = 0; i < PS3AV_HEAD_MAX; i++) | |
804 | ps3av->head[i] = PS3AV_CMD_VIDEO_HEAD_A + i; | |
805 | for (i = 0; i < PS3AV_OPT_PORT_MAX; i++) | |
806 | ps3av->opt_port[i] = PS3AV_CMD_AVPORT_SPDIF_0 + i; | |
eea820ab | 807 | for (i = 0; i < hw_conf->num_of_hdmi; i++) |
11227fd1 | 808 | ps3av->av_port[i] = PS3AV_CMD_AVPORT_HDMI_0 + i; |
eea820ab | 809 | for (j = 0; j < hw_conf->num_of_avmulti; j++) |
11227fd1 | 810 | ps3av->av_port[i + j] = PS3AV_CMD_AVPORT_AVMULTI_0 + j; |
eea820ab | 811 | for (k = 0; k < hw_conf->num_of_spdif; k++) |
11227fd1 GU |
812 | ps3av->av_port[i + j + k] = PS3AV_CMD_AVPORT_SPDIF_0 + k; |
813 | ||
814 | /* set all audio port */ | |
815 | ps3av->audio_port = PS3AV_CMD_AUDIO_PORT_HDMI_0 | |
816 | | PS3AV_CMD_AUDIO_PORT_HDMI_1 | |
817 | | PS3AV_CMD_AUDIO_PORT_AVMULTI_0 | |
818 | | PS3AV_CMD_AUDIO_PORT_SPDIF_0 | PS3AV_CMD_AUDIO_PORT_SPDIF_1; | |
819 | ||
820 | return 0; | |
821 | } | |
822 | ||
823 | /* set mode using id */ | |
824 | int ps3av_set_video_mode(u32 id, int boot) | |
825 | { | |
826 | int size; | |
827 | u32 option; | |
828 | ||
829 | size = ARRAY_SIZE(video_mode_table); | |
830 | if ((id & PS3AV_MODE_MASK) > size - 1 || id < 0) { | |
13a5e30c | 831 | dev_dbg(&ps3av->dev->core, "%s: error id :%d\n", __func__, id); |
11227fd1 GU |
832 | return -EINVAL; |
833 | } | |
834 | ||
835 | /* auto mode */ | |
836 | option = id & ~PS3AV_MODE_MASK; | |
837 | if ((id & PS3AV_MODE_MASK) == 0) { | |
13a5e30c | 838 | id = ps3av_auto_videomode(&ps3av->av_hw_conf, boot); |
11227fd1 | 839 | if (id < 1) { |
253f04e7 | 840 | printk(KERN_ERR "%s: invalid id :%d\n", __func__, id); |
11227fd1 GU |
841 | return -EINVAL; |
842 | } | |
843 | id |= option; | |
844 | } | |
845 | ||
846 | /* set videomode */ | |
13a5e30c GL |
847 | wait_for_completion(&ps3av->done); |
848 | ps3av->ps3av_mode_old = ps3av->ps3av_mode; | |
849 | ps3av->ps3av_mode = id; | |
11227fd1 | 850 | if (ps3av_set_videomode()) |
13a5e30c | 851 | ps3av->ps3av_mode = ps3av->ps3av_mode_old; |
11227fd1 GU |
852 | |
853 | return 0; | |
854 | } | |
855 | ||
856 | EXPORT_SYMBOL_GPL(ps3av_set_video_mode); | |
857 | ||
64072901 MK |
858 | int ps3av_get_auto_mode(int boot) |
859 | { | |
13a5e30c | 860 | return ps3av_auto_videomode(&ps3av->av_hw_conf, boot); |
64072901 MK |
861 | } |
862 | ||
863 | EXPORT_SYMBOL_GPL(ps3av_get_auto_mode); | |
864 | ||
11227fd1 GU |
865 | int ps3av_set_mode(u32 id, int boot) |
866 | { | |
867 | int res; | |
868 | ||
869 | res = ps3av_set_video_mode(id, boot); | |
870 | if (res) | |
871 | return res; | |
872 | ||
873 | res = ps3av_set_audio_mode(PS3AV_CMD_AUDIO_NUM_OF_CH_2, | |
874 | PS3AV_CMD_AUDIO_FS_48K, | |
875 | PS3AV_CMD_AUDIO_WORD_BITS_16, | |
876 | PS3AV_CMD_AUDIO_FORMAT_PCM, | |
877 | PS3AV_CMD_AUDIO_SOURCE_SERIAL); | |
878 | if (res) | |
879 | return res; | |
880 | ||
881 | return 0; | |
882 | } | |
883 | ||
884 | EXPORT_SYMBOL_GPL(ps3av_set_mode); | |
885 | ||
886 | int ps3av_get_mode(void) | |
887 | { | |
13a5e30c | 888 | return ps3av ? ps3av->ps3av_mode : 0; |
11227fd1 GU |
889 | } |
890 | ||
891 | EXPORT_SYMBOL_GPL(ps3av_get_mode); | |
892 | ||
893 | int ps3av_get_scanmode(int id) | |
894 | { | |
895 | int size; | |
896 | ||
897 | id = id & PS3AV_MODE_MASK; | |
898 | size = ARRAY_SIZE(video_mode_table); | |
899 | if (id > size - 1 || id < 0) { | |
253f04e7 | 900 | printk(KERN_ERR "%s: invalid mode %d\n", __func__, id); |
11227fd1 GU |
901 | return -EINVAL; |
902 | } | |
903 | return video_mode_table[id].interlace; | |
904 | } | |
905 | ||
906 | EXPORT_SYMBOL_GPL(ps3av_get_scanmode); | |
907 | ||
908 | int ps3av_get_refresh_rate(int id) | |
909 | { | |
910 | int size; | |
911 | ||
912 | id = id & PS3AV_MODE_MASK; | |
913 | size = ARRAY_SIZE(video_mode_table); | |
914 | if (id > size - 1 || id < 0) { | |
253f04e7 | 915 | printk(KERN_ERR "%s: invalid mode %d\n", __func__, id); |
11227fd1 GU |
916 | return -EINVAL; |
917 | } | |
918 | return video_mode_table[id].freq; | |
919 | } | |
920 | ||
921 | EXPORT_SYMBOL_GPL(ps3av_get_refresh_rate); | |
922 | ||
923 | /* get resolution by video_mode */ | |
924 | int ps3av_video_mode2res(u32 id, u32 *xres, u32 *yres) | |
925 | { | |
926 | int size; | |
927 | ||
928 | id = id & PS3AV_MODE_MASK; | |
929 | size = ARRAY_SIZE(video_mode_table); | |
930 | if (id > size - 1 || id < 0) { | |
253f04e7 | 931 | printk(KERN_ERR "%s: invalid mode %d\n", __func__, id); |
11227fd1 GU |
932 | return -EINVAL; |
933 | } | |
934 | *xres = video_mode_table[id].x; | |
935 | *yres = video_mode_table[id].y; | |
936 | return 0; | |
937 | } | |
938 | ||
939 | EXPORT_SYMBOL_GPL(ps3av_video_mode2res); | |
940 | ||
941 | /* mute */ | |
942 | int ps3av_video_mute(int mute) | |
943 | { | |
944 | return ps3av_set_av_video_mute(mute ? PS3AV_CMD_MUTE_ON | |
945 | : PS3AV_CMD_MUTE_OFF); | |
946 | } | |
947 | ||
948 | EXPORT_SYMBOL_GPL(ps3av_video_mute); | |
949 | ||
950 | int ps3av_audio_mute(int mute) | |
951 | { | |
952 | return ps3av_set_audio_mute(mute ? PS3AV_CMD_MUTE_ON | |
953 | : PS3AV_CMD_MUTE_OFF); | |
954 | } | |
955 | ||
956 | EXPORT_SYMBOL_GPL(ps3av_audio_mute); | |
957 | ||
13a5e30c GL |
958 | void ps3av_register_flip_ctl(void (*flip_ctl)(int on, void *data), |
959 | void *flip_data) | |
11227fd1 | 960 | { |
13a5e30c GL |
961 | mutex_lock(&ps3av->mutex); |
962 | ps3av->flip_ctl = flip_ctl; | |
963 | ps3av->flip_data = flip_data; | |
964 | mutex_unlock(&ps3av->mutex); | |
11227fd1 | 965 | } |
13a5e30c | 966 | EXPORT_SYMBOL_GPL(ps3av_register_flip_ctl); |
11227fd1 | 967 | |
13a5e30c | 968 | void ps3av_flip_ctl(int on) |
11227fd1 | 969 | { |
13a5e30c GL |
970 | mutex_lock(&ps3av->mutex); |
971 | if (ps3av->flip_ctl) | |
972 | ps3av->flip_ctl(on, ps3av->flip_data); | |
973 | mutex_unlock(&ps3av->mutex); | |
11227fd1 GU |
974 | } |
975 | ||
13a5e30c | 976 | static int ps3av_probe(struct ps3_system_bus_device *dev) |
11227fd1 GU |
977 | { |
978 | int res; | |
979 | u32 id; | |
980 | ||
13a5e30c GL |
981 | dev_dbg(&dev->core, " -> %s:%d\n", __func__, __LINE__); |
982 | dev_dbg(&dev->core, " timeout=%d\n", timeout); | |
11227fd1 | 983 | |
13a5e30c GL |
984 | if (ps3av) { |
985 | dev_err(&dev->core, "Only one ps3av device is supported\n"); | |
986 | return -EBUSY; | |
987 | } | |
5caf5db8 | 988 | |
13a5e30c GL |
989 | ps3av = kzalloc(sizeof(*ps3av), GFP_KERNEL); |
990 | if (!ps3av) | |
5caf5db8 | 991 | return -ENOMEM; |
11227fd1 | 992 | |
13a5e30c GL |
993 | mutex_init(&ps3av->mutex); |
994 | ps3av->ps3av_mode = 0; | |
995 | ps3av->dev = dev; | |
996 | ||
997 | INIT_WORK(&ps3av->work, ps3avd); | |
998 | init_completion(&ps3av->done); | |
999 | complete(&ps3av->done); | |
1000 | ps3av->wq = create_singlethread_workqueue("ps3avd"); | |
1001 | if (!ps3av->wq) | |
1002 | goto fail; | |
1003 | ||
11227fd1 GU |
1004 | switch (ps3_os_area_get_av_multi_out()) { |
1005 | case PS3_PARAM_AV_MULTI_OUT_NTSC: | |
13a5e30c | 1006 | ps3av->region = PS3AV_REGION_60; |
11227fd1 GU |
1007 | break; |
1008 | case PS3_PARAM_AV_MULTI_OUT_PAL_YCBCR: | |
1009 | case PS3_PARAM_AV_MULTI_OUT_SECAM: | |
13a5e30c | 1010 | ps3av->region = PS3AV_REGION_50; |
11227fd1 GU |
1011 | break; |
1012 | case PS3_PARAM_AV_MULTI_OUT_PAL_RGB: | |
13a5e30c | 1013 | ps3av->region = PS3AV_REGION_50 | PS3AV_REGION_RGB; |
11227fd1 GU |
1014 | break; |
1015 | default: | |
13a5e30c | 1016 | ps3av->region = PS3AV_REGION_60; |
11227fd1 GU |
1017 | break; |
1018 | } | |
1019 | ||
1020 | /* init avsetting modules */ | |
1021 | res = ps3av_cmd_init(); | |
1022 | if (res < 0) | |
253f04e7 | 1023 | printk(KERN_ERR "%s: ps3av_cmd_init failed %d\n", __func__, |
11227fd1 GU |
1024 | res); |
1025 | ||
13a5e30c GL |
1026 | ps3av_get_hw_conf(ps3av); |
1027 | id = ps3av_auto_videomode(&ps3av->av_hw_conf, 1); | |
1028 | mutex_lock(&ps3av->mutex); | |
1029 | ps3av->ps3av_mode = id; | |
1030 | mutex_unlock(&ps3av->mutex); | |
11227fd1 | 1031 | |
13a5e30c | 1032 | dev_dbg(&dev->core, " <- %s:%d\n", __func__, __LINE__); |
11227fd1 GU |
1033 | |
1034 | return 0; | |
13a5e30c GL |
1035 | |
1036 | fail: | |
1037 | kfree(ps3av); | |
1038 | ps3av = NULL; | |
1039 | return -ENOMEM; | |
11227fd1 GU |
1040 | } |
1041 | ||
13a5e30c | 1042 | static int ps3av_remove(struct ps3_system_bus_device *dev) |
11227fd1 | 1043 | { |
13a5e30c GL |
1044 | dev_dbg(&dev->core, " -> %s:%d\n", __func__, __LINE__); |
1045 | if (ps3av) { | |
11227fd1 | 1046 | ps3av_cmd_fin(); |
13a5e30c GL |
1047 | if (ps3av->wq) |
1048 | destroy_workqueue(ps3av->wq); | |
1049 | kfree(ps3av); | |
1050 | ps3av = NULL; | |
11227fd1 GU |
1051 | } |
1052 | ||
13a5e30c | 1053 | dev_dbg(&dev->core, " <- %s:%d\n", __func__, __LINE__); |
11227fd1 GU |
1054 | return 0; |
1055 | } | |
1056 | ||
13a5e30c | 1057 | static void ps3av_shutdown(struct ps3_system_bus_device *dev) |
11227fd1 | 1058 | { |
13a5e30c | 1059 | dev_dbg(&dev->core, " -> %s:%d\n", __func__, __LINE__); |
11227fd1 | 1060 | ps3av_remove(dev); |
13a5e30c | 1061 | dev_dbg(&dev->core, " <- %s:%d\n", __func__, __LINE__); |
11227fd1 GU |
1062 | } |
1063 | ||
1064 | static struct ps3_vuart_port_driver ps3av_driver = { | |
13a5e30c GL |
1065 | .core.match_id = PS3_MATCH_ID_AV_SETTINGS, |
1066 | .core.core.name = "ps3_av", | |
11227fd1 GU |
1067 | .probe = ps3av_probe, |
1068 | .remove = ps3av_remove, | |
1069 | .shutdown = ps3av_shutdown, | |
1070 | }; | |
1071 | ||
1072 | static int ps3av_module_init(void) | |
1073 | { | |
ef596c69 GU |
1074 | int error; |
1075 | ||
1076 | if (!firmware_has_feature(FW_FEATURE_PS3_LV1)) | |
1077 | return -ENODEV; | |
1078 | ||
13a5e30c GL |
1079 | pr_debug(" -> %s:%d\n", __func__, __LINE__); |
1080 | ||
ef596c69 | 1081 | error = ps3_vuart_port_driver_register(&ps3av_driver); |
11227fd1 GU |
1082 | if (error) { |
1083 | printk(KERN_ERR | |
1084 | "%s: ps3_vuart_port_driver_register failed %d\n", | |
253f04e7 | 1085 | __func__, error); |
11227fd1 GU |
1086 | return error; |
1087 | } | |
1088 | ||
13a5e30c | 1089 | pr_debug(" <- %s:%d\n", __func__, __LINE__); |
11227fd1 GU |
1090 | return error; |
1091 | } | |
1092 | ||
1093 | static void __exit ps3av_module_exit(void) | |
1094 | { | |
13a5e30c | 1095 | pr_debug(" -> %s:%d\n", __func__, __LINE__); |
11227fd1 | 1096 | ps3_vuart_port_driver_unregister(&ps3av_driver); |
13a5e30c | 1097 | pr_debug(" <- %s:%d\n", __func__, __LINE__); |
11227fd1 GU |
1098 | } |
1099 | ||
1100 | subsys_initcall(ps3av_module_init); | |
1101 | module_exit(ps3av_module_exit); | |
13a5e30c GL |
1102 | |
1103 | MODULE_LICENSE("GPL v2"); | |
1104 | MODULE_DESCRIPTION("PS3 AV Settings Driver"); | |
1105 | MODULE_AUTHOR("Sony Computer Entertainment Inc."); | |
1106 | MODULE_ALIAS(PS3_MODULE_ALIAS_AV_SETTINGS); |