Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / drivers / pcmcia / sa1111_badge4.c

diff --git a/kernel/drivers/pcmcia/sa1111_badge4.c b/kernel/drivers/pcmcia/sa1111_badge4.c
new file mode 100644 (file)
index 0000000..12f0dd0
--- /dev/null
+++ b/kernel/drivers/pcmcia/sa1111_badge4.c
@@ -0,0 +1,166 @@
+/*
+ * linux/drivers/pcmcia/sa1100_badge4.c
+ *
+ * BadgePAD 4 PCMCIA specific routines
+ *
+ *   Christopher Hoover <ch@hpl.hp.com>
+ *
+ * Copyright (C) 2002 Hewlett-Packard Company
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ *
+ */
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/device.h>
+#include <linux/errno.h>
+#include <linux/init.h>
+
+#include <mach/hardware.h>
+#include <asm/mach-types.h>
+#include <mach/badge4.h>
+#include <asm/hardware/sa1111.h>
+
+#include "sa1111_generic.h"
+
+/*
+ * BadgePAD 4 Details
+ *
+ * PCM Vcc:
+ *
+ *  PCM Vcc on BadgePAD 4 can be jumpered for 3v3 (short pins 1 and 3
+ *  on JP6) or 5v0 (short pins 3 and 5 on JP6).
+ *
+ * PCM Vpp:
+ *
+ *  PCM Vpp on BadgePAD 4 can be jumpered for 12v0 (short pins 4 and 6
+ *  on JP6) or tied to PCM Vcc (short pins 2 and 4 on JP6).  N.B.,
+ *  12v0 operation requires that the power supply actually supply 12v0
+ *  via pin 7 of JP7.
+ *
+ * CF Vcc:
+ *
+ *  CF Vcc on BadgePAD 4 can be jumpered either for 3v3 (short pins 1
+ *  and 2 on JP10) or 5v0 (short pins 2 and 3 on JP10).
+ *
+ * Unfortunately there's no way programmatically to determine how a
+ * given board is jumpered.  This code assumes a default jumpering
+ * as described below.
+ *
+ * If the defaults aren't correct, you may override them with a pcmv
+ * setup argument: pcmv=<pcm vcc>,<pcm vpp>,<cf vcc>.  The units are
+ * tenths of volts; e.g. pcmv=33,120,50 indicates 3v3 PCM Vcc, 12v0
+ * PCM Vpp, and 5v0 CF Vcc.
+ *
+ */
+
+static int badge4_pcmvcc = 50;  /* pins 3 and 5 jumpered on JP6 */
+static int badge4_pcmvpp = 50;  /* pins 2 and 4 jumpered on JP6 */
+static int badge4_cfvcc = 33;   /* pins 1 and 2 jumpered on JP10 */
+
+static void complain_about_jumpering(const char *whom,
+                                    const char *supply,
+                                    int given, int wanted)
+{
+       printk(KERN_ERR
+        "%s: %s %d.%dV wanted but board is jumpered for %s %d.%dV operation"
+        "; re-jumper the board and/or use pcmv=xx,xx,xx\n",
+              whom, supply,
+              wanted / 10, wanted % 10,
+              supply,
+              given / 10, given % 10);
+}
+
+static int
+badge4_pcmcia_configure_socket(struct soc_pcmcia_socket *skt, const socket_state_t *state)
+{
+       int ret;
+
+       switch (skt->nr) {
+       case 0:
+               if ((state->Vcc != 0) &&
+                   (state->Vcc != badge4_pcmvcc)) {
+                       complain_about_jumpering(__func__, "pcmvcc",
+                                                badge4_pcmvcc, state->Vcc);
+                       // Apply power regardless of the jumpering.
+                       // return -1;
+               }
+               if ((state->Vpp != 0) &&
+                   (state->Vpp != badge4_pcmvpp)) {
+                       complain_about_jumpering(__func__, "pcmvpp",
+                                                badge4_pcmvpp, state->Vpp);
+                       return -1;
+               }
+               break;
+
+       case 1:
+               if ((state->Vcc != 0) &&
+                   (state->Vcc != badge4_cfvcc)) {
+                       complain_about_jumpering(__func__, "cfvcc",
+                                                badge4_cfvcc, state->Vcc);
+                       return -1;
+               }
+               break;
+
+       default:
+               return -1;
+       }
+
+       ret = sa1111_pcmcia_configure_socket(skt, state);
+       if (ret == 0) {
+               unsigned long flags;
+               int need5V;
+
+               local_irq_save(flags);
+
+               need5V = ((state->Vcc == 50) || (state->Vpp == 50));
+
+               badge4_set_5V(BADGE4_5V_PCMCIA_SOCK(skt->nr), need5V);
+
+               local_irq_restore(flags);
+       }
+
+       return ret;
+}
+
+static struct pcmcia_low_level badge4_pcmcia_ops = {
+       .owner                  = THIS_MODULE,
+       .configure_socket       = badge4_pcmcia_configure_socket,
+       .first                  = 0,
+       .nr                     = 2,
+};
+
+int pcmcia_badge4_init(struct sa1111_dev *dev)
+{
+       int ret = -ENODEV;
+
+       if (machine_is_badge4()) {
+               printk(KERN_INFO
+                      "%s: badge4_pcmvcc=%d, badge4_pcmvpp=%d, badge4_cfvcc=%d\n",
+                      __func__,
+                      badge4_pcmvcc, badge4_pcmvpp, badge4_cfvcc);
+
+               sa11xx_drv_pcmcia_ops(&badge4_pcmcia_ops);
+               ret = sa1111_pcmcia_add(dev, &badge4_pcmcia_ops,
+                               sa11xx_drv_pcmcia_add_one);
+       }
+
+       return ret;
+}
+
+static int __init pcmv_setup(char *s)
+{
+       int v[4];
+
+       s = get_options(s, ARRAY_SIZE(v), v);
+
+       if (v[0] >= 1) badge4_pcmvcc = v[1];
+       if (v[0] >= 2) badge4_pcmvpp = v[2];
+       if (v[0] >= 3) badge4_cfvcc = v[3];
+
+       return 1;
+}
+
+__setup("pcmv=", pcmv_setup);