ca1b35f033b10c8be52ce244245e27918a763378
[sfrench/cifs-2.6.git] / drivers / video / fbdev / via / via_aux_sii164.c
1 /*
2  * Copyright 2011 Florian Tobias Schandinat <FlorianSchandinat@gmx.de>
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU General Public
6  * License as published by the Free Software Foundation;
7  * either version 2, or (at your option) any later version.
8  *
9  * This program is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTIES OR REPRESENTATIONS; without even
11  * the implied warranty of MERCHANTABILITY or FITNESS FOR
12  * A PARTICULAR PURPOSE.See the GNU General Public License
13  * for more details.
14  *
15  * You should have received a copy of the GNU General Public License
16  * along with this program; if not, write to the Free Software
17  * Foundation, Inc.,
18  * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
19  */
20 /*
21  * driver for Silicon Image SiI 164 PanelLink Transmitter
22  */
23
24 #include <linux/slab.h>
25 #include "via_aux.h"
26
27
28 static const char *name = "SiI 164 PanelLink Transmitter";
29
30
31 static void probe(struct via_aux_bus *bus, u8 addr)
32 {
33         struct via_aux_drv drv = {
34                 .bus    =       bus,
35                 .addr   =       addr,
36                 .name   =       name};
37         /* check vendor id and device id */
38         const u8 id[] = {0x01, 0x00, 0x06, 0x00}, len = ARRAY_SIZE(id);
39         u8 tmp[len];
40
41         if (!via_aux_read(&drv, 0x00, tmp, len) || memcmp(id, tmp, len))
42                 return;
43
44         printk(KERN_INFO "viafb: Found %s at address 0x%x\n", name, addr);
45         via_aux_add(&drv);
46 }
47
48 void via_aux_sii164_probe(struct via_aux_bus *bus)
49 {
50         u8 i;
51
52         for (i = 0x38; i <= 0x3F; i++)
53                 probe(bus, i);
54 }