razzor
/
qnapd
0
0
Fork 0
Code Issues Pull Requests Releases Activity

change lcd_* interface

This commit is contained in:
Olaf Rempel 2011-04-17 17:37:38 +02:00
parent bc54aecceb
commit 2db5472a8d
3 changed files with 100 additions and 85 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

35
lcd.c
View File

@ -33,13 +33,14 @@ struct lcddev {
struct termios oldtio;
int backlight_timeout;
int (*button_cb)(struct lcddev *dev, int button);
int (*button_cb)(struct lcddev *dev, int button, void *privdata);
void *privdata;
struct event_fd *read_event;
struct event_timeout *backlight_event;
};
static void lcd_close(struct lcddev *dev)
void lcd_close(struct lcddev *dev)
{
tcsetattr(dev->fd, TCSANOW, &dev->oldtio);
close(dev->fd);
@ -91,7 +92,7 @@ static int lcd_read(struct lcddev *dev, const char *buf, int len)
#if _LCD_DEBUG
fprintf(stderr, "lcd_read[%d/%d]: ", cnt, len);
for (i = 0; i < cnt; i++)
fprintf(stderr, "0x%X ", buf[i]);
fprintf(stderr, "0x%X ", (unsigned char)buf[i]);
fprintf(stderr, "\n");
#endif
return (cnt != 0) ? cnt : retval;
@ -105,7 +106,7 @@ static int lcd_write(struct lcddev *dev, char *buf, int len)
#if _LCD_DEBUG
fprintf(stderr, "lcd_write[%d/%d]: ", retval, len);
for (i = 0; i < retval; i++)
fprintf(stderr, "0x%X ", buf[i]);
fprintf(stderr, "0x%X ", (unsigned char)buf[i]);
fprintf(stderr, "\n");
#endif
return retval;
@ -177,48 +178,56 @@ static int lcd_read_cb(int fd, void *privdata)
return 0;
}
int retval = 0;
char expect1[] = A125_EVENT_BUTTON1;
char expect2[] = A125_EVENT_BUTTON2;
if (memcmp(buf, expect1, sizeof(buf)) == 0) {
dev->button_cb(dev, LCD_BUTTON1);
lcd_trigger_backlight(dev);
retval = dev->button_cb(dev, LCD_BUTTON1, dev->privdata);
} else if (memcmp(buf, expect2, sizeof(buf)) == 0) {
dev->button_cb(dev, LCD_BUTTON2);
retval = dev->button_cb(dev, LCD_BUTTON2, dev->privdata);
}
if (retval) {
lcd_trigger_backlight(dev);
}
return 0;
}
int lcd_init(const char *devicename, int backlight_timeout, int (*button_cb)(struct lcddev *dev, int button))
struct lcddev * lcd_init(const char *devicename,
int backlight_timeout,
int (*button_cb)(struct lcddev *dev, int button, void *privdata),
void *privdata)
{
struct lcddev *dev = malloc(sizeof(struct lcddev));
if (dev == NULL) {
log_print(LOG_ERROR, "lcd_init(): out of memory");
return -1;
return NULL;
}
memset(dev, 0, sizeof(struct lcddev));
if (lcd_open(dev, devicename) < 0) {
free(dev);
return -1;
return NULL;
}
if (lcd_reset(dev) < 0) {
log_print(LOG_ERROR, "lcd_init(): could not reset LCD");
lcd_close(dev);
free(dev);
return -1;
return NULL;
}
dev->backlight_timeout = backlight_timeout;
lcd_trigger_backlight(dev);
dev->button_cb = button_cb;
button_cb(dev, LCD_BUTTON0);
dev->privdata = privdata;
button_cb(dev, LCD_BUTTON0, dev->privdata);
dev->read_event = event_add_readfd(NULL, dev->fd, lcd_read_cb, dev);
return 0;
return dev;
}

7
lcd.h
View File

@ -7,7 +7,12 @@
struct lcddev; /* private data */
int lcd_init(const char *device, int backlight_timeout, int (*button_callback)(struct lcddev *dev, int button));
struct lcddev * lcd_init(const char *device,
int backlight_timeout,
int (*button_callback)(struct lcddev *dev, int button, void *privdata),
void *privdata);
void lcd_close(struct lcddev *dev);
int lcd_setline(struct lcddev *dev, int line, const char *text);
#endif /* _LCD_H_ */

7
qnaplcd.c
View File

@ -52,7 +52,7 @@ static struct option opts[] = {
static int page;
static int button_callback(struct lcddev *dev, int button)
static int button_callback(struct lcddev *dev, int button, void *privdata)
{
if (button == LCD_BUTTON2)
page = (page < PAGE_MAX) ? page +1 : 0;
@ -189,13 +189,14 @@ int main(int argc, char *argv[])
log_print(LOG_EVERYTIME, "qnaplcd started (pid:%d)", getpid());
while (1) {
if (lcd_init(LCD_DEVICE, LCD_TIMEOUT, &button_callback) < 0)
struct lcddev *dev = lcd_init(LCD_DEVICE, LCD_TIMEOUT, &button_callback, NULL);
if (dev == NULL)
break;
/* exited on restart / SIGUSR1 */
event_loop(check_restart, NULL, (void *)&restart_var);
// TODO: need lcd_close()
lcd_close(dev);
config_free();