summaryrefslogtreecommitdiff
path: root/sysutils/sjog/files/patch-src::sonypi.c
diff options
context:
space:
mode:
Diffstat (limited to 'sysutils/sjog/files/patch-src::sonypi.c')
-rw-r--r--sysutils/sjog/files/patch-src::sonypi.c434
1 files changed, 434 insertions, 0 deletions
diff --git a/sysutils/sjog/files/patch-src::sonypi.c b/sysutils/sjog/files/patch-src::sonypi.c
new file mode 100644
index 000000000000..d8093dac544a
--- /dev/null
+++ b/sysutils/sjog/files/patch-src::sonypi.c
@@ -0,0 +1,434 @@
+--- 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();
++}
++
++
++
++
generated by cgit v1.2.3 (git 2.25.1) at 2025-09-07 16:14:13 +0000