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[ARRAY_SIZE(id)];
  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 }