path: root/mdk-stage1/pcmcia/probe.c

/*
 * Guillaume Cottenceau (gc)
 *
 * Copyright 2000-2001 Mandriva
 *
 * This software may be freely redistributed under the terms of the GNU
 * public license.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 *
 *
 * Code comes from /anonymous@projects.sourceforge.net:/pub/pcmcia-cs/pcmcia-cs-3.1.29.tar.bz2
 */

/*======================================================================

    PCMCIA controller probe

    probe.c 1.55 2001/08/24 12:19:20

    The contents of this file are subject to the Mozilla Public
    License Version 1.1 (the "License"); you may not use this file
    except in compliance with the License. You may obtain a copy of
    the License at http://www.mozilla.org/MPL/

    Software distributed under the License is distributed on an "AS
    IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
    implied. See the License for the specific language governing
    rights and limitations under the License.

    The initial developer of the original code is David A. Hinds
    <dahinds@users.sourceforge.net>.  Portions created by David A. Hinds
    are Copyright (C) 1999 David A. Hinds.  All Rights Reserved.

    Alternatively, the contents of this file may be used under the
    terms of the GNU General Public License version 2 (the "GPL"), in
    which case the provisions of the GPL are applicable instead of the
    above.  If you wish to allow the use of your version of this file
    only under the terms of the GPL and not to allow others to use
    your version of this file under the MPL, indicate your decision
    by deleting the provisions above and replace them with the notice
    and other provisions required by the GPL.  If you do not delete
    the provisions above, a recipient may use your version of this
    file under either the MPL or the GPL.
    
======================================================================*/

#include <sys/types.h>
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <errno.h>
#include <fcntl.h>

//mdk-stage1// #include <pcmcia/config.h>
#include "log.h"
#include "pcmcia.h"

/*====================================================================*/

//mdk-stage1// #ifdef CONFIG_PCI

typedef struct {
    u_short	vendor, device;
    char	*modname;
    char	*name;
} pci_id_t;

pci_id_t pci_id[] = {
    { 0x1013, 0x1100, "pd6729", "Cirrus Logic CL 6729" },
    { 0x1013, 0x1110, "yenta_socket", "Cirrus Logic PD 6832" },
    { 0x104c, 0x8011, "yenta_socket", "" },
    { 0x104c, 0x8031, "yenta_socket", "Texas Instruments|PCIxx21/x515 Cardbus Controller" },
    { 0x104c, 0x8036, "yenta_socket", "Texas Instruments|PCI6515 Cardbus Controller" },
    { 0x104c, 0x8039, "yenta_socket", "Texas Instruments|PCIxx12 Cardbus Controller " },
    { 0x104c, 0xac12, "yenta_socket", "Texas Instruments PCI1130" }, 
    { 0x104c, 0xac13, "yenta_socket", "Texas Instruments PCI1031" }, 
    { 0x104c, 0xac15, "yenta_socket", "Texas Instruments PCI1131" }, 
    { 0x104c, 0xac16, "yenta_socket", "Texas Instruments PCI1250" }, 
    { 0x104c, 0xac17, "yenta_socket", "Texas Instruments PCI1220" }, 
    { 0x104c, 0xac19, "yenta_socket", "Texas Instruments PCI1221" }, 
    { 0x104c, 0xac1a, "yenta_socket", "Texas Instruments PCI1210" }, 
    { 0x104c, 0xac1b, "yenta_socket", "Texas Instruments PCI1450" }, 
    { 0x104c, 0xac1c, "yenta_socket", "Texas Instruments PCI1225" }, 
    { 0x104c, 0xac1d, "yenta_socket", "Texas Instruments PCI1251A" }, 
    { 0x104c, 0xac1e, "yenta_socket", "Texas Instruments PCI1211" }, 
    { 0x104c, 0xac1f, "yenta_socket", "Texas Instruments PCI1251B" }, 
    { 0x104c, 0xac40, "yenta_socket", "Texas Instruments PCI4450" }, 
    { 0x104c, 0xac41, "yenta_socket", "Texas Instruments PCI4410" }, 
    { 0x104c, 0xac42, "yenta_socket", "Texas Instruments PCI4451" }, 
    { 0x104c, 0xac44, "yenta_socket", "Texas Instruments PCI4510" }, 
    { 0x104c, 0xac46, "yenta_socket", "Texas Instruments PCI4520" }, 
    { 0x104c, 0xac47, "yenta_socket", "Texas Instruments PCI7510" }, 
    { 0x104c, 0xac48, "yenta_socket", "Texas Instruments PCI7610" }, 
    { 0x104c, 0xac49, "yenta_socket", "Texas Instruments PCI7410" }, 
    { 0x104c, 0xac50, "yenta_socket", "Texas Instruments PCI1410" }, 
    { 0x104c, 0xac51, "yenta_socket", "Texas Instruments PCI1420" }, 
    { 0x104c, 0xac52, "yenta_socket", "Texas Instruments PCI1451" }, 
    { 0x104c, 0xac54, "yenta_socket", "Texas Instruments PCI1620" }, 
    { 0x104c, 0xac55, "yenta_socket", "Texas Instruments PCI1520" }, 
    { 0x104c, 0xac56, "yenta_socket", "Texas Instruments PCI1510" }, 
    { 0x104c, 0xac8d, "yenta_socket", "Texas Instruments|PCI7620" },
    { 0x104c, 0xac8e, "yenta_socket", "Texas Instruments|PCI7420 CardBus Controller" },
    { 0x104c, 0xac8e, "yenta_socket", "Texas Instruments PCI7420" },
    { 0x10b3, 0xb106, "yenta_socket", "SMC 34C90" },
    { 0x1179, 0x0603, "pd6729", "Toshiba ToPIC95-A" }, 
    { 0x1179, 0x060a, "yenta_socket", "Toshiba ToPIC95-B" }, 
    { 0x1179, 0x060f, "yenta_socket", "Toshiba ToPIC97" }, 
    { 0x1179, 0x0617, "yenta_socket", "Toshiba ToPIC100" }, 
    { 0x1180, 0x0465, "yenta_socket", "Ricoh RL5C465" },
    { 0x1180, 0x0466, "yenta_socket", "Ricoh RL5C466" },
    { 0x1180, 0x0475, "yenta_socket", "Ricoh RL5C475" },
    { 0x1180, 0x0476, "yenta_socket", "Ricoh RL5C476" },
    { 0x1180, 0x0477, "yenta_socket", "Ricoh RL5C477" },
    { 0x1180, 0x0478, "yenta_socket", "Ricoh RL5C478" },
    { 0x119b, 0x1221, "pd6729", "Omega Micro 82C092G" }, 
    { 0x1524, 0x1211, "yenta_socket", "ENE 1211" },
    { 0x1524, 0x1225, "yenta_socket", "ENE 1225" },
    { 0x1524, 0x1410, "yenta_socket", "ENE 1410" },
    { 0x1524, 0x1411, "yenta_socket", "ENE Technology CB1411" },
    { 0x1524, 0x1412, "yenta_socket", "ENE Technology Inc|CB-712/4 Cardbus Controller " },
    { 0x1524, 0x1420, "yenta_socket", "ENE 1420" },
    { 0x1524, 0x1421, "yenta_socket", "ENE Technology Inc|CB-720/2/4 Cardbus Controller" },
    { 0x1524, 0x1422, "yenta_socket", "ENE Technology Inc|CB-722/4 Cardbus Controller" },
    { 0x8086, 0x1221, "i82092", "Intel 82092AA_0" }, 
    { 0x8086, 0x1222, "i82092", "Intel 82092AA_1" }, 
};
#define PCI_COUNT (sizeof(pci_id)/sizeof(pci_id_t))

char * driver = NULL;

static int pci_probe(void)
{
    char s[256], *name = NULL;
    u_int device, vendor, i;
    FILE *f;
    
//mdk-stage1//     if (!module)
    log_message("PCMCIA: probing PCI bus..");

    if ((f = fopen("/proc/bus/pci/devices", "r")) != NULL) {
	while (fgets(s, 256, f) != NULL) {
	    u_int n = strtoul(s+5, NULL, 16);
	    vendor = (n >> 16); device = (n & 0xffff);
	    if (vendor == 0x1217) {
		driver = "yenta_socket";
		name = "O2 Micro|PCMCIA Controller";
		break;
	    }
	    for (i = 0; i < PCI_COUNT; i++)
		if ((vendor == pci_id[i].vendor) &&
		    (device == pci_id[i].device)) break;
	    if (i < PCI_COUNT) {
		name = pci_id[i].name;
		driver = pci_id[i].modname;
	    }
	}
    }
//mdk-stage1// else if ((f = fopen("/proc/pci", "r")) != NULL) {
//mdk-stage1// 	while (fgets(s, 256, f) != NULL) {
//mdk-stage1// 	    t = strstr(s, "Device id=");
//mdk-stage1// 	    if (t) {
//mdk-stage1// 		device = strtoul(t+10, NULL, 16);
//mdk-stage1// 		t = strstr(s, "Vendor id=");
//mdk-stage1// 		vendor = strtoul(t+10, NULL, 16);
//mdk-stage1// 		for (i = 0; i < PCI_COUNT; i++)
//mdk-stage1// 		    if ((vendor == pci_id[i].vendor) &&
//mdk-stage1// 			(device == pci_id[i].device)) break;
//mdk-stage1// 	    } else
//mdk-stage1// 		for (i = 0; i < PCI_COUNT; i++)
//mdk-stage1// 		    if (strstr(s, pci_id[i].tag) != NULL) break;
//mdk-stage1// 	    if (i != PCI_COUNT) {
//mdk-stage1// 		name = pci_id[i].name;
//mdk-stage1// 		break;
//mdk-stage1// 	    } else {
//mdk-stage1// 		t = strstr(s, "CardBus bridge");
//mdk-stage1// 		if (t != NULL) {
//mdk-stage1// 		    name = t + 16;
//mdk-stage1// 		    t = strchr(s, '(');
//mdk-stage1// 		    t[-1] = '\0';
//mdk-stage1// 		    break;
//mdk-stage1// 		}
//mdk-stage1// 	    }
//mdk-stage1// 	}
//mdk-stage1//     }
    fclose(f);

    if (name) {
//mdk-stage1// 	if (module)
//mdk-stage1// 	    printf("i82365\n");
//mdk-stage1// 	else
	    log_message("\t%s found, 2 sockets (driver %s).", name, driver);
	return 0;
    } else {
//mdk-stage1// 	if (!module)
	    log_message("\tnot found.");
	return -ENODEV;
    }
}
//mdk-stage1// #endif

/*====================================================================*/

//mdk-stage1// #ifdef CONFIG_ISA
//mdk-stage1// 
//mdk-stage1// #ifdef __GLIBC__
#include <sys/io.h>
//mdk-stage1// #else
//mdk-stage1// #include <asm/io.h>
//mdk-stage1// #endif
typedef u_short ioaddr_t;

#include "i82365.h"
#include "cirrus.h"
#include "vg468.h"

static ioaddr_t i365_base = 0x03e0;

static u_char i365_get(u_short sock, u_short reg)
{
    u_char val = I365_REG(sock, reg);
    outb(val, i365_base); val = inb(i365_base+1);
    return val;
}

static void i365_set(u_short sock, u_short reg, u_char data)
{
    u_char val = I365_REG(sock, reg);
    outb(val, i365_base); outb(data, i365_base+1);
}

static void i365_bset(u_short sock, u_short reg, u_char mask)
{
    u_char d = i365_get(sock, reg);
    d |= mask;
    i365_set(sock, reg, d);
}

static void i365_bclr(u_short sock, u_short reg, u_char mask)
{
    u_char d = i365_get(sock, reg);
    d &= ~mask;
    i365_set(sock, reg, d);
}

int i365_probe(void)
{
    int val, sock, done;
    char *name = "i82365sl";

//mdk-stage1// if (!module)
    log_message("PCMCIA: probing for Intel PCIC (ISA)..");
//mdk-stage1//     if (verbose) printf("\n");
    
    sock = done = 0;
    if (ioperm(i365_base, 4, 1)) {
               log_perror("PCMCIA: ioperm");
               return -1;
    }
    ioperm(0x80, 1, 1);
    for (; sock < 2; sock++) {
	val = i365_get(sock, I365_IDENT);
//mdk-stage1//	if (verbose)
//mdk-stage1//	    printf("  ident(%d)=%#2.2x", sock, val); 
	switch (val) {
	case 0x82:
	    name = "i82365sl A step";
	    break;
	case 0x83:
	    name = "i82365sl B step";
	    break;
	case 0x84:
	    name = "VLSI 82C146";
	    break;
	case 0x88: case 0x89: case 0x8a:
	    name = "IBM Clone";
	    break;
	case 0x8b: case 0x8c:
	    break;
	default:
	    done = 1;
	}
	if (done) break;
    }

//mdk-stage1//    if (verbose) printf("\n  ");
    if (sock == 0) {
//mdk-stage1//	if (!module)
	log_message("\tnot found.");
	return -ENODEV;
    }

    if ((sock == 2) && (strcmp(name, "VLSI 82C146") == 0))
	name = "i82365sl DF";

    /* Check for Vadem chips */
    outb(0x0e, i365_base);
    outb(0x37, i365_base);
    i365_bset(0, VG468_MISC, VG468_MISC_VADEMREV);
    val = i365_get(0, I365_IDENT);
    if (val & I365_IDENT_VADEM) {
	if ((val & 7) < 4)
	    name = "Vadem VG-468";
	else
	    name = "Vadem VG-469";
	i365_bclr(0, VG468_MISC, VG468_MISC_VADEMREV);
    }
    
    /* Check for Cirrus CL-PD67xx chips */
    i365_set(0, PD67_CHIP_INFO, 0);
    val = i365_get(0, PD67_CHIP_INFO);
    if ((val & PD67_INFO_CHIP_ID) == PD67_INFO_CHIP_ID) {
	val = i365_get(0, PD67_CHIP_INFO);
	if ((val & PD67_INFO_CHIP_ID) == 0) {
	    if (val & PD67_INFO_SLOTS)
		name = "Cirrus CL-PD672x";
	    else {
		name = "Cirrus CL-PD6710";
		sock = 1;
	    }
	    i365_set(0, PD67_EXT_INDEX, 0xe5);
	    if (i365_get(0, PD67_EXT_INDEX) != 0xe5)
		name = "VIA VT83C469";
	}
    }

//mdk-stage1//    if (module)
//mdk-stage1//	printf("i82365\n");
//mdk-stage1//    else
	printf("\t%s found, %d sockets.\n", name, sock);
    return 0;
    
} /* i365_probe */

//mdk-stage1//#endif /* CONFIG_ISA */

/*====================================================================*/

//mdk-stage1//#ifdef CONFIG_ISA

#include "tcic.h"

//mdk-stage1//static ioaddr_t tcic_base = TCIC_BASE;

static u_char tcic_getb(ioaddr_t base, u_char reg)
{
    u_char val = inb(base+reg);
    return val;
}

static void tcic_setb(ioaddr_t base, u_char reg, u_char data)
{
    outb(data, base+reg);
}

static u_short tcic_getw(ioaddr_t base, u_char reg)
{
    u_short val = inw(base+reg);
    return val;
}

static void tcic_setw(ioaddr_t base, u_char reg, u_short data)
{
    outw(data, base+reg);
}

static u_short tcic_aux_getw(ioaddr_t base, u_short reg)
{
    u_char mode = (tcic_getb(base, TCIC_MODE) & TCIC_MODE_PGMMASK) | reg;
    tcic_setb(base, TCIC_MODE, mode);
    return tcic_getw(base, TCIC_AUX);
}

static void tcic_aux_setw(ioaddr_t base, u_short reg, u_short data)
{
    u_char mode = (tcic_getb(base, TCIC_MODE) & TCIC_MODE_PGMMASK) | reg;
    tcic_setb(base, TCIC_MODE, mode);
    tcic_setw(base, TCIC_AUX, data);
}

static int get_tcic_id(ioaddr_t base)
{
    u_short id;
    tcic_aux_setw(base, TCIC_AUX_TEST, TCIC_TEST_DIAG);
    id = tcic_aux_getw(base, TCIC_AUX_ILOCK);
    id = (id & TCIC_ILOCKTEST_ID_MASK) >> TCIC_ILOCKTEST_ID_SH;
    tcic_aux_setw(base, TCIC_AUX_TEST, 0);
    return id;
}

int tcic_probe_at(ioaddr_t base)
{
    int i;
    u_short old;
    
    /* Anything there?? */
    for (i = 0; i < 0x10; i += 2)
	if (tcic_getw(base, i) == 0xffff)
	    return -1;

//mdk-stage1//    if (!module)
    log_message("\tat %#3.3x: ", base); fflush(stdout);

    /* Try to reset the chip */
    tcic_setw(base, TCIC_SCTRL, TCIC_SCTRL_RESET);
    tcic_setw(base, TCIC_SCTRL, 0);
    
    /* Can we set the addr register? */
    old = tcic_getw(base, TCIC_ADDR);
    tcic_setw(base, TCIC_ADDR, 0);
    if (tcic_getw(base, TCIC_ADDR) != 0) {
	tcic_setw(base, TCIC_ADDR, old);
	return -2;
    }
    
    tcic_setw(base, TCIC_ADDR, 0xc3a5);
    if (tcic_getw(base, TCIC_ADDR) != 0xc3a5)
	return -3;

    return 2;
}

int tcic_probe(void)
{
    int sock, id;

//mdk-stage1//     if (!module)
    log_message("PCMCIA: probing for Databook TCIC-2 (ISA).."); fflush(stdout);
    
    if (ioperm(TCIC_BASE, 16, 1)) {
	    log_perror("PCMCIA: ioperm");
	    return -1;
    }
    ioperm(0x80, 1, 1);
    sock = tcic_probe_at(TCIC_BASE);
    
    if (sock <= 0) {
//mdk-stage1//	if (!module)
	    log_message("\tnot found.");
	return -ENODEV;
    }

//mdk-stage1//    if (module)
//mdk-stage1//	printf("tcic\n");
//mdk-stage1//    else {
	id = get_tcic_id(TCIC_BASE);
	switch (id) {
	case TCIC_ID_DB86082:
	    log_message("DB86082"); break;
	case TCIC_ID_DB86082A:
	    log_message("DB86082A"); break;
	case TCIC_ID_DB86084:
	    log_message("DB86084"); break;
	case TCIC_ID_DB86084A:
	    log_message("DB86084A"); break;
	case TCIC_ID_DB86072:
	    log_message("DB86072"); break;
	case TCIC_ID_DB86184:
	    log_message("DB86184"); break;
	case TCIC_ID_DB86082B:
	    log_message("DB86082B"); break;
	default:
	    log_message("Unknown TCIC-2 ID 0x%02x", id);
	}
	log_message(" found at %#6x, %d sockets.", TCIC_BASE, sock);
//mdk-stage1//     }
    return 0;
    
} /* tcic_probe */

//mdk-stage1// #endif /* CONFIG_ISA */

//mdk-stage1// /*====================================================================*/
//mdk-stage1// 
//mdk-stage1// int main(int argc, char *argv[])
//mdk-stage1// {
//mdk-stage1//     int optch, errflg;
//mdk-stage1//     extern char *optarg;
//mdk-stage1//     int verbose = 0, module = 0;
//mdk-stage1//     
//mdk-stage1//     errflg = 0;
//mdk-stage1//     while ((optch = getopt(argc, argv, "t:vxm")) != -1) {
//mdk-stage1// 	switch (optch) {
//mdk-stage1// #ifdef CONFIG_ISA
//mdk-stage1// 	case 't':
//mdk-stage1// 	    tcic_base = strtoul(optarg, NULL, 0); break;
//mdk-stage1// #endif
//mdk-stage1// 	case 'v':
//mdk-stage1// 	    verbose = 1; break;
//mdk-stage1// 	case 'm':
//mdk-stage1// 	    module = 1; break;
//mdk-stage1// 	default:
//mdk-stage1// 	    errflg = 1; break;
//mdk-stage1// 	}
//mdk-stage1//     }
//mdk-stage1//     if (errflg || (optind < argc)) {
//mdk-stage1// 	fprintf(stderr, "usage: %s [-t tcic_base] [-v] [-m]\n", argv[0]);
//mdk-stage1// 	exit(EXIT_FAILURE);
//mdk-stage1//     }
//mdk-stage1// 
//mdk-stage1// #ifdef CONFIG_PCI
//mdk-stage1//     if (pci_probe(verbose, module) == 0)
//mdk-stage1// 	exit(EXIT_SUCCESS);
//mdk-stage1// #endif
//mdk-stage1// #ifdef CONFIG_ISA
//mdk-stage1//     if (i365_probe(verbose, module) == 0)
//mdk-stage1// 	exit(EXIT_SUCCESS);
//mdk-stage1//     else if (tcic_probe(verbose, module, tcic_base) == 0)
//mdk-stage1// 	exit(EXIT_SUCCESS);
//mdk-stage1// #endif
//mdk-stage1//     exit(EXIT_FAILURE);
//mdk-stage1//     return 0;
//mdk-stage1// }


char * pcmcia_probe(void)
{
	if (!pci_probe())
		return driver;
#if !defined(__x86_64__) 
	else if (!i365_probe())
		return "pd6729";
	else if (!tcic_probe())
		return "tcic";
#endif
	else
		return NULL;
}