--- src/sonypi.c.orig	Sat Aug 17 20:38:56 2002
+++ src/sonypi.c	Sat Aug 17 20:38:56 2002
@@ -0,0 +1,431 @@
+/* sony programmable I/O control device (SPIC) functions for picturebook 
+
+   Tridge and sfr, July 2000
+
+   FreeBSD modifications by Jay Kuri jk@oneway.com 08/13/01 
+*/
+/* 
+   Copyright (C) Andrew Tridgell 2000
+   
+   This program is free software; you can redistribute it and/or modify
+   it under the terms of the GNU General Public License as published by
+   the Free Software Foundation; either version 2 of the License, or
+   (at your option) any later version.
+   
+   This program is distributed in the hope that it will be useful,
+   but WITHOUT ANY WARRANTY; without even the implied warranty of
+   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+   GNU General Public License for more details.
+   
+   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.
+*/
+
+
+#include "sonypi.h"
+#include "pci.h"
+
+static int spic_fd;
+static int debug=0;
+#ifdef LINUX
+static void OUTB(u8 v, int port)
+{
+	outb(v, port);
+}
+
+static u8 INB(int port)
+{
+	usleep(10);
+	return inb(port);
+}
+#define OUTW outw
+#else ifdef __FreeBSD__
+#include <machine/cpufunc.h>
+void OUTB(u8 v, unsigned int port)
+{
+	outb(port,v);
+}
+void OUTW(u16 v, unsigned int port)
+{
+	outw(port,v);
+}
+
+static u8 INB(unsigned int port)
+{
+	usleep(10);
+	return inb(port);
+}
+static int deviofd=-1;
+int iopl(int lvl)
+{
+  if(lvl==0){
+    if(deviofd!=-1){
+      close(deviofd);
+      deviofd=-1;
+    }    
+    return 0;
+  }else if(lvl==3){
+    if(deviofd==-1){
+      deviofd=open("/dev/io",0);
+    }
+    return deviofd;
+  }
+  return -1;
+}
+
+#endif
+/* initialise the SPIC - this comes from the AML code in the ACPI bios */
+static void spic_srs(int fd, u16 port1, u16 port2, u8 irq)
+{
+	u8 v;
+	u16 v2;
+
+	pci_config_write_u16(fd, SPI_G10A, port1);
+	pci_config_read_u8(fd, SPI_G10L, &v);
+	v = (v & 0xF0) | (port1 ^ port2);
+	pci_config_write_u8(fd, SPI_G10L, v);
+
+	v2 = inw(SPI_IRQ_PORT);
+	v2 &= ~(0x3 << SPI_IRQ_SHIFT);
+	v2 |= (irq << SPI_IRQ_SHIFT);
+	OUTW(v2, SPI_IRQ_PORT);
+
+	pci_config_read_u8(fd, SPI_G10L, &v);
+	v = (v & 0x1F) | 0xC0;
+	pci_config_write_u8(fd, SPI_G10L, v);
+}
+
+/* disable the SPIC - this comes from the AML code in the ACPI bios */
+static void spic_dis(void)
+{
+	u8 v1;
+	u16 v;
+
+	pci_config_read_u8(spic_fd, SPI_G10L, &v1);
+	pci_config_write_u8(spic_fd, SPI_G10L, v1 & 0x3F);
+
+	v = inw(SPI_IRQ_PORT);
+	v |= (0x3 << SPI_IRQ_SHIFT);
+	OUTW(v, SPI_IRQ_PORT);
+	close(spic_fd);
+}
+
+
+static void spic_settle(void)
+{
+	while (INB(SPIC_PORT2) & 2) usleep(1);
+}
+
+static u8 spic_call1(u8 dev)
+{
+	u8 v1, v2;
+	spic_settle();
+
+	OUTB(dev, SPIC_PORT2);
+	v1 = INB(SPIC_PORT2);
+	v2 = INB(SPIC_PORT1);
+	if (debug)
+		printf("spic call1(%x) -> %x %x\n", dev, v1, v2);
+	return v2;
+}
+
+static u8 spic_call2(u8 dev, u8 fn)
+{
+	u8 v1;
+
+	while (INB(SPIC_PORT2) & 2) ;
+	OUTB(dev, SPIC_PORT2);
+
+	while (INB(SPIC_PORT2) & 2) ;
+	OUTB(fn, SPIC_PORT1);
+
+	v1 = INB(SPIC_PORT1);
+	if (debug)
+		printf("spic call2(%x, %x) -> %x\n", dev, fn, v1);
+	return v1;
+}
+
+static u8 spic_call3(u8 dev, u8 fn, u8 v)
+{
+	u8 v1;
+
+	while (INB(SPIC_PORT2) & 2) ;
+	OUTB(dev, SPIC_PORT2);
+
+	while (INB(SPIC_PORT2) & 2) ;
+	OUTB(fn, SPIC_PORT1);
+
+	while (INB(SPIC_PORT2) & 2) ;
+	OUTB(v, SPIC_PORT1);
+
+	v1 = INB(SPIC_PORT1);
+	if (debug)
+		printf("call3(%x, %x, %x) -> %x\n", dev, fn, v, v1);
+	return v1;
+}
+
+static u8 spic_read(u8 fn)
+{
+	u8 v1, v2;
+	int n = 100;
+	while (n--) {
+		v1 = spic_call2(0x8f, fn);
+		v2 = spic_call2(0x8f, fn);
+		if (v1 == v2 && v1 != 0xff) {
+			return v1;
+		}
+	}
+	return 0xff;
+}
+
+/* set brightness, hue etc */
+static void spic_set(u8 fn, u8 v)
+{
+	int n = 100;
+	while (n--) {
+		if (spic_call3(0x90, fn, v) == 0) break;
+	}
+}
+
+static int spic_camera_ready(void)
+{
+	u8 v = spic_call2(0x8f, SPIC_CAMERA_STATUS);
+	return (v != 0xff && (v & SPIC_CAMERA_STATUS_READY));
+}
+
+/* turn the camera off */
+void spic_camera_off(void)
+{
+	spic_call2(0x91, 0);
+}
+
+/* turn the camera on */
+void spic_camera_on(void)
+{
+	int i;
+
+	while (spic_call2(0x91, 0x1) != 0) usleep(1);
+	spic_call1(0x93);
+
+	if (!spic_camera_ready()) {
+		printf("waiting for camera ready\n");
+		for (i=400;i>0;i--) {
+			if (spic_camera_ready()) break;
+			usleep(100);
+		}
+		if (i == 0) {
+			printf("failed to power on camera\n");
+			return;
+		}
+	}
+
+	spic_set(0x10, 0x5a);
+}
+
+/* return 0 if capture not pressed, return 1 if pressed to partial,
+   return 2 if fully pressed */
+int spic_capture_pressed(void)
+{
+	u8 v1, v2;
+	v1 = inb(SPIC_PORT1);
+	v2 = inb(SPIC_PORT2);
+	if (v2 != 0x60) return 0;
+	if (v1 == SPIC_EVENT_CAPTURE_PARTIAL) return 1;
+	if (v1 == SPIC_EVENT_CAPTURE_FULL) return 2;
+	return 0;
+}
+
+int spic_jogger_pressed(void)
+{
+	u8 v1, v2;
+	v1 = inb(SPIC_PORT1);
+	v2 = inb(SPIC_PORT2);
+	return (v1 == 0x40 && v2 == 0x10);
+}
+
+int spic_jogger_turned(void)
+{
+	u8 v1, v2;
+	v1 = inb(SPIC_PORT1);
+	v2 = inb(SPIC_PORT2);
+	if ((v2 & 0x10) == 0 || v1 == 0) return 0;
+	/* the following clears the evnet bits */
+	spic_call2(0x81, 0xff);
+	return (signed char)v1;
+}
+
+int spic_jogger(void)
+{
+	u8 v1, v2, ov1=0, ov2=1;
+	while (1) {
+		v1 = INB(SPIC_PORT1);
+		v2 = INB(SPIC_PORT2);
+		if (v1 != ov1 || v2 != ov2) {
+			printf("event 0x%02x 0x%02x\n", v1, v2);
+		}
+		ov1 = v1;
+		ov2 = v2;
+	}
+}
+
+void spic_settings(int brightness, int contrast, int hue, int color, int sharpness, int picture, int agc)
+{
+	spic_set(SPIC_CAMERA_BRIGHTNESS, brightness);
+	spic_set(SPIC_CAMERA_CONTRAST, contrast);
+	spic_set(SPIC_CAMERA_HUE, hue);
+	spic_set(SPIC_CAMERA_COLOR, color);
+	spic_set(SPIC_CAMERA_SHARPNESS, sharpness);
+	spic_set(SPIC_CAMERA_PICTURE, picture);
+	spic_set(SPIC_CAMERA_AGC, agc);
+}
+
+void spic_setup_vga(void)
+{
+/* :about to start capture again
 */
+OUTB(0x09, 0x03CE); usleep(10);
+inb(0x03CF); usleep(10); /* -> 00000026 */
+OUTW(0x2609, 0x03CE); usleep(10);
+OUTB(0x0A, 0x03CE); usleep(10);
+inb(0x03CF); usleep(10); /* -> 00000021 */
+OUTW(0x210A, 0x03CE); usleep(10);
+OUTB(0x08, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 00000020 */
+OUTB(0x09, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 000000F3 */
+OUTW(0x2008, 0x03C4); usleep(10);
+OUTW(0xF309, 0x03C4); usleep(10);
+OUTW(0x2609, 0x03CE); usleep(10);
+OUTW(0x210A, 0x03CE); usleep(10);
+OUTB(0x09, 0x03CE); usleep(10);
+inb(0x03CF); usleep(10); /* -> 00000026 */
+OUTW(0x2609, 0x03CE); usleep(10);
+OUTB(0x0A, 0x03CE); usleep(10);
+inb(0x03CF); usleep(10); /* -> 00000021 */
+OUTW(0x210A, 0x03CE); usleep(10);
+OUTB(0x08, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 00000020 */
+OUTB(0x09, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 000000F3 */
+OUTW(0xF109, 0x03C4); usleep(10);
+OUTW(0x2609, 0x03CE); usleep(10);
+OUTW(0x210A, 0x03CE); usleep(10);
+OUTB(0x09, 0x03CE); usleep(10);
+inb(0x03CF); usleep(10); /* -> 00000026 */
+OUTW(0x2609, 0x03CE); usleep(10);
+OUTB(0x0A, 0x03CE); usleep(10);
+inb(0x03CF); usleep(10); /* -> 00000021 */
+OUTW(0x210A, 0x03CE); usleep(10);
+OUTB(0x08, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 00000020 */
+OUTB(0x09, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 0000001F */
+OUTW(0x1D09, 0x03C4); usleep(10);
+OUTW(0x2609, 0x03CE); usleep(10);
+OUTW(0x210A, 0x03CE); usleep(10);
+OUTB(0x08, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 00002621 */
+OUTB(0x09, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 000026E9 */
+OUTB(0x08, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 00002621 */
+OUTB(0x09, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 000026F9 */
+OUTB(0x09, 0x03CE); usleep(10);
+inb(0x03CF); usleep(10); /* -> 00000026 */
+OUTB(0x09, 0x03CE); usleep(10);
+OUTB(0x26, 0x03CF); usleep(10);
+OUTB(0x0A, 0x03CE); usleep(10);
+inb(0x03CF); usleep(10); /* -> 00000021 */
+OUTB(0x0A, 0x03CE); usleep(10);
+OUTB(0x21, 0x03CF); usleep(10);
+OUTB(0x0F, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 00000001 */
+OUTB(0x0F, 0x03C4); usleep(10);
+OUTB(0x01, 0x03C5); usleep(10);
+OUTB(0x0F, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 00000001 */
+OUTB(0x0A, 0x03CE); usleep(10);
+OUTB(0x21, 0x03CF); usleep(10);
+OUTB(0x09, 0x03CE); usleep(10);
+OUTB(0x26, 0x03CF); usleep(10);
+OUTB(0x09, 0x03CE); usleep(10);
+inb(0x03CF); usleep(10); /* -> 00000026 */
+OUTW(0x2609, 0x03CE); usleep(10);
+OUTB(0xBF, 0x03CE); usleep(10);
+inb(0x03CF); usleep(10); /* -> 00000000 */
+OUTB(0xA3, 0x03CE); usleep(10);
+inb(0x03CF); usleep(10); /* -> 0000000C */
+OUTW(0xBF, 0x03CE); usleep(10);
+OUTW(0x0CA3, 0x03CE); usleep(10);
+OUTB(0x09, 0x03CE); usleep(10);
+inb(0x03CF); usleep(10); /* -> 00000026 */
+OUTW(0x2609, 0x03CE); usleep(10);
+OUTB(0x0A, 0x03CE); usleep(10);
+inb(0x03CF); usleep(10); /* -> 00000021 */
+OUTW(0x210A, 0x03CE); usleep(10);
+OUTB(0x08, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 00000021 */
+OUTB(0x09, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 000000F9 */
+OUTW(0x2609, 0x03CE); usleep(10);
+OUTW(0x210A, 0x03CE); usleep(10);
+OUTB(0x08, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 00002621 */
+OUTB(0x09, 0x03C4); usleep(10);
+inb(0x03C5); usleep(10); /* -> 000026F9 */
+}
+
+void spic_show_settings(void)
+{
+	printf("Brightness %d  ", spic_read(SPIC_CAMERA_BRIGHTNESS));
+	printf("Color %d  ", spic_read(SPIC_CAMERA_COLOR));
+	printf("Contrast %d  ", spic_read(SPIC_CAMERA_CONTRAST));
+	printf("Hue %d  ", spic_read(SPIC_CAMERA_HUE));
+	printf("Sharpness %d\n", spic_read(SPIC_CAMERA_SHARPNESS));
+	printf("Picture 0x%02x  ", spic_read(SPIC_CAMERA_PICTURE));
+	printf("AGC 0x%02x  ", spic_read(SPIC_CAMERA_AGC));
+	printf("Direction: %s\n", (spic_read(SPIC_CAMERA_STATUS) & SPIC_DIRECTION_BACKWARDS) ? "back":"front");
+	printf("RomVersion: %d  ", spic_read(SPIC_CAMERA_ROMVERSION));
+	printf("Revision: %d\n", spic_read(SPIC_CAMERA_REVISION));
+}
+
+void spic_init(void)
+{
+	spic_fd = pci_find_device(SPIC_PCI_VENDOR, SPIC_PCI_DEVICE);
+	if (spic_fd == -1) {
+		printf("can't find spic PCI device\n");
+		exit(1);
+	}
+
+	iopl(3);
+	spic_srs(spic_fd, SPIC_PORT1, SPIC_PORT2, 0x3);
+
+	spic_call1(0x82);
+	spic_call2(0x81, 0xff);
+	spic_call1(0x92);
+
+//	printf("spic enabled\n");
+}
+
+void sdelay(u32 usecs)
+{
+	INB(SPIC_PORT1);
+	INB(SPIC_PORT2);
+	usleep(usecs);
+}
+
+void spic_shutdown(int power_off)
+{
+	spic_set(SPIC_CAMERA_PICTURE, SPIC_CAMERA_MUTE_MASK);
+	spic_call2(0x81, 0); /* make sure we don't get any more events */
+	if (power_off) {
+		spic_camera_off();
+		printf("camera off\n");
+	}
+	spic_dis();
+}
+
+
+
+