aboutsummaryrefslogtreecommitdiffstats
path: root/plugin_fifo.c
blob: 714066d17d68c3ac09fc5ae7713d41ec6f474fb3 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
/* $Id$
 * $URL$
 *
 * plugin template
 *
 * Copyright (C) 2008 Michael Vogt <michu@neophob.com>
 * Copyright (C) 2004, 2005, 2006, 2007, 2008 The LCD4Linux Team <lcd4linux-devel@users.sourceforge.net>
 *
 * This file is part of LCD4Linux.
 *
 * LCD4Linux 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, or (at your option)
 * any later version.
 *
 * LCD4Linux 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.
 *
 */

/* 
 * Quick fifo hack for lcd4linux
 * 
 * most code is ripped ...
 *
 */

/* define the include files you need */
#include "config.h"

#include <stdlib.h>
#include <string.h>
#include <ctype.h>
#include <errno.h>
#include <unistd.h>
#include <fcntl.h>
#include <sys/stat.h>
#include <signal.h>

/* these should always be included */
#include "debug.h"
#include "plugin.h"
#include "cfg.h"

#ifdef WITH_DMALLOC
#include <dmalloc.h>
#endif

#define FIFO_BUFFER_SIZE 80

typedef struct _FifoData {
    char *path;
    int input;
    int created;
} FifoData;

static char Section[] = "Plugin:FIFO";
static FifoData fd;
static char msg[FIFO_BUFFER_SIZE];
static char fifopath[1024];


static void configure_fifo(void)
{
    char *s;
    memset(fifopath, 0, 1024);
    s = cfg_get(Section, "fifopath", "/tmp/lcd4linux.fifo");
    if (*s == '\0') {
	info("[FIFO] empty '%s.fifopath' entry from %s, assuming '/tmp/lcd4linux.fifo'", Section, cfg_source());
	strcpy(fifopath, "/tmp/lcd4linux.fifo");
    } else {
	strcpy(fifopath, s);
	info("[FIFO] read '%s.fifopath', value is '%s'", Section, fifopath);
    }
    free(s);
}


static void removeFifo()
{
    debug("Removing FIFO \"%s\"\n", fd.path);
    if (unlink(fd.path) < 0) {
	error("Could not remove FIFO \"%s\": %s\n", fd.path, strerror(errno));
	return;
    }
    fd.created = 0;
}


static void closeFifo()
{
    struct stat st;
    if (fd.input >= 0) {
	close(fd.input);
	fd.input = -1;
    }
    if (fd.created && (stat(fd.path, &st) == 0))
	removeFifo(fd);
}

static int makeFifo()
{
    if (mkfifo(fd.path, 0666) < 0) {
	error("Couldn't create FIFO \"%s\": %s\n", fd.path, strerror(errno));
	return -1;
    }
    fd.created = 1;
    return 0;
}


static int checkFifo()
{
    struct stat st;
    if (stat(fd.path, &st) < 0) {
	if (errno == ENOENT) {

	    /* Path doesn't exist */
	    return makeFifo(fd);
	}
	error("Failed to stat FIFO \"%s\": %s\n", fd.path, strerror(errno));
	return -1;
    }
    if (!S_ISFIFO(st.st_mode)) {
	error("\"%s\" already exists, but is not a FIFO\n", fd.path);
	return -1;
    }
    return 0;
}


static int openFifo()
{
    if (checkFifo() < 0)
	return -1;
    fd.input = open(fd.path, O_RDONLY | O_NONBLOCK);
    if (fd.input < 0) {
	error("Could not open FIFO \"%s\" for reading: %s\n", fd.path, strerror(errno));
	closeFifo();
	return -1;
    }
    return 0;
}


static void fiforead(RESULT * result)
{
    char buf[FIFO_BUFFER_SIZE];
    unsigned int i;
    int bytes = 1;
    memset(buf, 0, FIFO_BUFFER_SIZE);
    strcat(buf, "ERROR");

    if (checkFifo() == 0) {
	memset(buf, 0, FIFO_BUFFER_SIZE);

	while (bytes > 0 && errno != EINTR) {
	    bytes = read(fd.input, buf, FIFO_BUFFER_SIZE);
	}

	if (bytes < 0 || errno > 0) {
	    error("[FIFO] Error %i: %s", errno, strerror(errno));
	} else {
	    if (strlen(buf) > 0) {
		strcpy(msg, buf);
	    }
	    for (i = 0; i < strlen(buf); i++) {
		if (msg[i] < 0x20)
		    msg[i] = ' ';
	    }
	}
    }
    /* store result */
    SetResult(&result, R_STRING, msg);
}


/* plugin initialization */
int plugin_init_fifo(void)
{
    configure_fifo();
    fd.path = fifopath;
    fd.input = -1;
    fd.created = 0;
    if (openFifo() < 0) {
	return -1;
    }

    /* ignore broken pipe */
    signal(SIGPIPE, SIG_IGN);

    memset(msg, 0, FIFO_BUFFER_SIZE);
    AddFunction("fifo::read", 0, fiforead);
    return 0;
}


void plugin_exit_fifo(void)
{

    /* close filedescriptors */
    closeFifo();
}
p++) { /* select page */ drv_L7_page(p); /* select column address */ drv_L7_write_ctrl(0x00); drv_L7_write_ctrl(0x10); for (c = 0; c < SCOLS; c++) { drv_L7_write_data(0); } } } static void drv_L7_blit(const int row, const int col, const int height, const int width) { int r, p, c, a; unsigned char m; /* transfer layout to display framebuffer */ for (r = row; r < row + height; r++) { /* do not process extra row for symbols */ if (r >= SROWS - 1) break; /* page */ p = r / 8; for (c = col; c < col + width; c++) { if (c >= SCOLS) break; /* RAM address */ a = p * SCOLS + c; /* bit mask */ m = 1 << (r % 8); if (drv_generic_graphic_black(r, c)) { /* set bit */ Buffer1[a] |= m; } else { /* clear bit */ Buffer1[a] &= ~m; } } } /* process display framebuffer */ for (p = row / 8; p <= (row + height) / 8; p++) { int i, j, a, e; if (p >= PAGES) break; for (i = col; i < col + width; i++) { if (i >= SCOLS) break; a = p * SCOLS + i; if (Buffer1[a] == Buffer2[a]) continue; for (j = i, e = 0; i < col + width; i++) { a = p * SCOLS + i; if (Buffer1[a] == Buffer2[a]) { if (++e > 2) break; } else { e = 0; } } /* select page */ drv_L7_page(p); /* column address */ /* first column address = 32 */ drv_L7_write_ctrl(0x00 | ((j + 32) & 0x0f)); drv_L7_write_ctrl(0x10 | ((j + 32) >> 4)); /* data */ for (j = j; j <= i - e; j++) { a = p * SCOLS + j; drv_L7_write_data(Buffer1[a]); Buffer2[a] = Buffer1[a]; } } } } static int drv_L7_GPO(const int num, const int val) { int v = 0; switch (num) { case 0: /* battery symbol */ v = (val > 0) ? 1 : 0; drv_L7_put(32, v); break; case 1: /* battery level */ if (val < 0) { v = 0; drv_L7_put(46, v); drv_L7_put(47, v); drv_L7_put(48, v); drv_L7_put(49, v); } else { v = val & 0x0f; drv_L7_put(46, (v & 1) ? 1 : 0); drv_L7_put(47, (v & 2) ? 1 : 0); drv_L7_put(48, (v & 4) ? 1 : 0); drv_L7_put(49, (v & 8) ? 1 : 0); } break; case 2: /* earpiece */ v = (val > 0) ? 1 : 0; drv_L7_put(59, v); break; case 3: /* triangle */ v = (val > 0) ? 1 : 0; drv_L7_put(69, v); Buffer1[8 * SCOLS + 69 - 32] = (val > 0); break; case 4: /* head */ v = (val > 0) ? 1 : 0; drv_L7_put(83, v); Buffer1[8 * SCOLS + 83 - 32] = (val > 0); break; case 5: /* message */ v = (val > 0) ? 1 : 0; drv_L7_put(98, v); Buffer1[8 * SCOLS + 98 - 32] = (val > 0); break; case 6: /* antenna */ v = (val > 0) ? 1 : 0; drv_L7_put(117, v); Buffer1[8 * SCOLS + 117 - 32] = (val > 0); break; case 7: /* signal level */ if (val < 0) { v = 0; drv_L7_put(112, v); drv_L7_put(113, v); drv_L7_put(114, v); drv_L7_put(115, v); } else { v = val & 0x0f; drv_L7_put(112, (v & 1) ? 1 : 0); drv_L7_put(113, (v & 2) ? 1 : 0); drv_L7_put(114, (v & 4) ? 1 : 0); drv_L7_put(115, (v & 8) ? 1 : 0); } break; } return v; } static int drv_L7_contrast(int contrast) { if (contrast < 0) contrast = 0; if (contrast > 31) contrast = 31; drv_L7_write_ctrl(0x80 | contrast); return contrast; } static int drv_L7_start(const char *section) { char *s; int contrast; /* fixed size */ DROWS = 64; DCOLS = 100; GPOS = 8; /* SED1560 display RAM layout */ PAGES = 8; SROWS = 64; SCOLS = 166; s = cfg_get(section, "Font", "6x8"); if (s == NULL || *s == '\0') { error("%s: no '%s.Font' entry from %s", Name, section, cfg_source()); return -1; } XRES = -1; YRES = -1; if (sscanf(s, "%dx%d", &XRES, &YRES) != 2 || XRES < 1 || YRES < 1) { error("%s: bad Font '%s' from %s", Name, s, cfg_source()); return -1; } /* Fixme: provider other fonts someday... */ if (XRES != 6 && YRES != 8) { error("%s: bad Font '%s' from %s (only 6x8 at the moment)", Name, s, cfg_source()); return -1; } /* provide room for page 8 (symbols) */ Buffer1 = malloc(PAGES * SCOLS); if (Buffer1 == NULL) { error("%s: framebuffer #1 could not be allocated: malloc() failed", Name); return -1; } Buffer2 = malloc(PAGES * SCOLS); if (Buffer2 == NULL) { error("%s: framebuffer #2 could not be allocated: malloc() failed", Name); return -1; } memset(Buffer1, 0, PAGES * SCOLS * sizeof(*Buffer1)); memset(Buffer2, 0, PAGES * SCOLS * sizeof(*Buffer2)); if (drv_generic_parport_open(section, Name) != 0) { error("%s: could not initialize parallel port!", Name); return -1; } if ((SIGNAL_RES = drv_generic_parport_hardwire_ctrl("RES", "INIT")) == 0xff) return -1; if ((SIGNAL_CS1 = drv_generic_parport_hardwire_ctrl("CS1", "STROBE")) == 0xff) return -1; if ((SIGNAL_RW = drv_generic_parport_hardwire_ctrl("RW", "SLCTIN")) == 0xff) return -1; if ((SIGNAL_A0 = drv_generic_parport_hardwire_ctrl("A0", "AUTOFD")) == 0xff) return -1; /* rise RES, CS1, RW and A0 */ drv_generic_parport_control(SIGNAL_RES | SIGNAL_CS1 | SIGNAL_RW | SIGNAL_A0, SIGNAL_RES | SIGNAL_CS1 | SIGNAL_RW | SIGNAL_A0); /* set direction: write */ drv_generic_parport_direction(0); /* reset display: lower RESET for 1 usec */ drv_generic_parport_control(SIGNAL_RES, 0); udelay(1); drv_generic_parport_control(SIGNAL_RES, SIGNAL_RES); udelay(100); /* just to make sure: send a software reset */ drv_L7_write_ctrl(0xe2); udelay(20000); drv_L7_write_ctrl(0xAE); /* Display off */ drv_L7_write_ctrl(0x40); /* Start Display Line = 0 */ drv_L7_write_ctrl(0x20); /* reverse line driving off */ drv_L7_write_ctrl(0xCC); /* OutputStatus = $0C, 102x64 */ drv_L7_write_ctrl(0xA0); /* ADC = normal */ drv_L7_write_ctrl(0xA9); /* LCD-Duty = 1/64 */ drv_L7_write_ctrl(0xAB); /* LCD-Duty +1 (1/65, symbols) */ drv_L7_write_ctrl(0x25); /* power supply on */ udelay(100 * 1000); /* wait 100 msec */ drv_L7_write_ctrl(0xED); /* power supply on completion */ drv_L7_write_ctrl(0x8F); /* Contrast medium */ drv_L7_write_ctrl(0xA4); /* Display Test off */ drv_L7_write_ctrl(0xAF); /* Display on */ drv_L7_write_ctrl(0xA6); /* Display on */ /* clear display */ drv_L7_clear(); if (cfg_number(section, "Contrast", 15, 0, 31, &contrast) > 0) { drv_L7_contrast(contrast); } return 0; } /****************************************/ /*** plugins ***/ /****************************************/ static void plugin_contrast(RESULT * result, RESULT * arg1) { double contrast = drv_L7_contrast(R2N(arg1)); SetResult(&result, R_NUMBER, &contrast); } /****************************************/ /*** exported functions ***/ /****************************************/ /* list models */ int drv_L7_list(void) { printf("LPH7508"); return 0; } /* initialize driver & display */ int drv_L7_init(const char *section, const int quiet) { int ret; info("%s: %s", Name, "$Rev$"); /* real worker functions */ drv_generic_graphic_real_blit = drv_L7_blit; drv_generic_gpio_real_set = drv_L7_GPO; /* start display */ if ((ret = drv_L7_start(section)) != 0) return ret; /* initialize generic graphic driver */ if ((ret = drv_generic_graphic_init(section, Name)) != 0) return ret; /* initialize generic GPIO driver */ if ((ret = drv_generic_gpio_init(section, Name)) != 0) return ret; if (!quiet) { char buffer[40]; qprintf(buffer, sizeof(buffer), "%s %dx%d", Name, DCOLS, DROWS); if (drv_generic_graphic_greet(buffer, NULL)) { sleep(3); drv_generic_graphic_clear(); } } /* register plugins */ AddFunction("LCD::contrast", 1, plugin_contrast); return 0; } /* close driver & display */ int drv_L7_quit(const int quiet) { info("%s: shutting down display.", Name); drv_generic_graphic_clear(); if (!quiet) { drv_generic_graphic_greet("goodbye!", NULL); } drv_generic_graphic_quit(); drv_generic_gpio_quit(); drv_generic_parport_close(); if (Buffer1) { free(Buffer1); Buffer1 = NULL; } if (Buffer2) { free(Buffer2); Buffer2 = NULL; } return (0); } DRIVER drv_LPH7508 = { .name = Name, .list = drv_L7_list, .init = drv_L7_init, .quit = drv_L7_quit, };