mirror of
https://github.com/oliverschmidt/contiki.git
synced 2024-11-18 12:05:11 +00:00
636 lines
15 KiB
C
636 lines
15 KiB
C
/*
|
|
* Copyright (c) 2004 Swedish Institute of Computer Science.
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without modification,
|
|
* are permitted provided that the following conditions are met:
|
|
*
|
|
* 1. Redistributions of source code must retain the above copyright notice,
|
|
* this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright notice,
|
|
* this list of conditions and the following disclaimer in the documentation
|
|
* and/or other materials provided with the distribution.
|
|
* 3. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
|
|
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT
|
|
* SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
|
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
|
|
* OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
|
|
* IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
|
|
* OF SUCH DAMAGE.
|
|
*
|
|
* $Id: display.c,v 1.4 2006/10/23 09:01:06 adamdunkels Exp $
|
|
*
|
|
* Author: Adam Dunkels <adam@sics.se>
|
|
*
|
|
*/
|
|
|
|
#include "dev/leds.h"
|
|
#include "display.h"
|
|
#include "nodes.h"
|
|
#include "node.h"
|
|
#include "ether.h"
|
|
#include "lib/list.h"
|
|
#include "lib/memb.h"
|
|
#include "sensor.h"
|
|
|
|
#include <gtk/gtk.h>
|
|
|
|
#include <stdio.h>
|
|
|
|
static GdkPixmap *pixmap = NULL;
|
|
static GtkWidget *drawing_area;
|
|
static GdkFont *font;
|
|
|
|
#define DISPLAY_WIDTH 400
|
|
#define DISPLAY_HEIGHT 300
|
|
|
|
#define BASESTATION_SIZE 4
|
|
|
|
#define MAPSCALE 20
|
|
#define SCALE 2
|
|
|
|
#define MARK_SIZE 8
|
|
|
|
#define DOT_SIZE ether_strength()
|
|
#define DOT_INTENSITY 3
|
|
|
|
struct dot {
|
|
struct dot *next;
|
|
int x, y;
|
|
int size;
|
|
int intensity;
|
|
};
|
|
|
|
MEMB(dotsmem, struct dot, 20000);
|
|
LIST(dots);
|
|
LIST(tempdots);
|
|
|
|
static int window_is_open;
|
|
|
|
static GdkGC *intensity_gcs[DOT_INTENSITY];
|
|
|
|
static GdkGC *intensity_clusterhead;
|
|
static GdkGC *intensity_clusterhead_lightgray;
|
|
static GdkGC *intensity_clusterhead_red;
|
|
|
|
static GdkGC *green, *red, *yellow, *black, *white;
|
|
|
|
static struct nodes_node *marked_node;
|
|
|
|
/*-----------------------------------------------------------------------------------*/
|
|
void
|
|
display_redraw(void)
|
|
{
|
|
int i, j;
|
|
struct nodes_node *n, *m;
|
|
char string[20];
|
|
int x, y;
|
|
struct dot *d;
|
|
GdkGC *color;
|
|
|
|
if(!window_is_open) {
|
|
return;
|
|
}
|
|
|
|
gdk_draw_rectangle(pixmap,
|
|
white,
|
|
TRUE,
|
|
0, 0,
|
|
drawing_area->allocation.width,
|
|
drawing_area->allocation.height);
|
|
|
|
|
|
for(i = 0; i < nodes_num(); ++i) {
|
|
n = nodes_node(i);
|
|
x = n->x;
|
|
y = n->y;
|
|
|
|
/* if(n->type == NODE_TYPE_CLUSTERHEAD) {
|
|
gdk_draw_arc(pixmap,
|
|
intensity_clusterhead_lightgray,
|
|
TRUE,
|
|
x * SCALE - DOT_SIZE * SCALE,
|
|
y * SCALE - DOT_SIZE * SCALE,
|
|
DOT_SIZE * 2 * SCALE, DOT_SIZE * 2 * SCALE,
|
|
0, 360 * 64);
|
|
}*/
|
|
|
|
if(n == marked_node) {
|
|
gdk_draw_arc(pixmap,
|
|
red,
|
|
FALSE,
|
|
x * SCALE - MARK_SIZE * SCALE,
|
|
y * SCALE - MARK_SIZE * SCALE,
|
|
MARK_SIZE * 2 * SCALE, MARK_SIZE * 2 * SCALE,
|
|
0, 360 * 64);
|
|
}
|
|
|
|
}
|
|
|
|
for(i = 0; i < nodes_num(); ++i) {
|
|
n = nodes_node(i);
|
|
x = n->x;
|
|
y = n->y;
|
|
|
|
/* if(n->type == NODE_TYPE_CLUSTERHEAD) {
|
|
gdk_draw_rectangle(pixmap,
|
|
intensity_clusterhead_red,
|
|
TRUE,
|
|
x * SCALE,
|
|
y * SCALE,
|
|
3, 3);
|
|
for(j = 0; j < nodes_num(); ++j) {
|
|
m = nodes_node(j);
|
|
if(m->type == NODE_TYPE_CLUSTERHEAD &&
|
|
((x - m->x) * (x - m->x) +
|
|
(y - m->y) * (y - m->y) < ether_strength() * ether_strength())) {
|
|
gdk_draw_line(pixmap,
|
|
intensity_clusterhead,
|
|
x * SCALE,
|
|
y * SCALE,
|
|
m->x * SCALE,
|
|
m->y * SCALE);
|
|
|
|
|
|
}
|
|
}
|
|
} else */ {
|
|
|
|
if(strlen(n->text) > 0) {
|
|
gdk_draw_string(pixmap,
|
|
font,
|
|
black,
|
|
x * SCALE + 2,
|
|
y * SCALE - 1,
|
|
n->text);
|
|
|
|
}
|
|
gdk_draw_rectangle(pixmap,
|
|
black,
|
|
TRUE,
|
|
x * SCALE,
|
|
y * SCALE,
|
|
2, 2);
|
|
/* gdk_draw_rectangle(pixmap,
|
|
drawing_area->style->white_gc,
|
|
TRUE,
|
|
x * SCALE,
|
|
y * SCALE,
|
|
2, 2);*/
|
|
if(n->leds & LEDS_GREEN) {
|
|
gdk_draw_rectangle(pixmap,
|
|
green,
|
|
TRUE,
|
|
x * SCALE + 2,
|
|
y * SCALE,
|
|
4, 4);
|
|
}
|
|
if(n->leds & LEDS_YELLOW) {
|
|
gdk_draw_rectangle(pixmap,
|
|
yellow,
|
|
TRUE,
|
|
x * SCALE,
|
|
y * SCALE + 2,
|
|
4, 4);
|
|
}
|
|
if(n->leds & LEDS_RED) {
|
|
gdk_draw_rectangle(pixmap,
|
|
red,
|
|
TRUE,
|
|
x * SCALE + 2,
|
|
y * SCALE + 2,
|
|
4, 4);
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
for(d = list_head(dots); d != NULL; d = d->next) {
|
|
gdk_draw_arc(pixmap,
|
|
intensity_gcs[d->intensity - 1],
|
|
FALSE,
|
|
d->x * SCALE - d->size * SCALE,
|
|
d->y * SCALE - d->size * SCALE,
|
|
d->size * 2 * SCALE, d->size * 2 * SCALE,
|
|
0, 360 * 64);
|
|
}
|
|
|
|
|
|
gtk_widget_draw(drawing_area, NULL);
|
|
|
|
}
|
|
/*-----------------------------------------------------------------------------------*/
|
|
void
|
|
display_tick(void)
|
|
{
|
|
struct dot *d, *e;
|
|
struct ether_packet *p;
|
|
|
|
if(!window_is_open) {
|
|
return;
|
|
}
|
|
|
|
/* Fade out active dots. The intensity value of each dot is counted
|
|
downwards, and those dots that still have an intensity are placed
|
|
in a temporary list. The temporary list is then copied into the
|
|
list of all dots. */
|
|
|
|
list_init(tempdots);
|
|
|
|
for(d = list_head(dots);
|
|
d != NULL;
|
|
d = e) {
|
|
if(d != NULL) {
|
|
e = d->next;
|
|
} else {
|
|
e = NULL;
|
|
}
|
|
if(d->size > 20) {
|
|
d->size /= 2;
|
|
} else {
|
|
d->size -= 4;
|
|
}
|
|
/* --(d->intensity);*/
|
|
if(d->size > 0) {
|
|
list_push(tempdots, d);
|
|
} else {
|
|
memb_free(&dotsmem, (void *)d);
|
|
}
|
|
}
|
|
list_copy(dots, tempdots);
|
|
|
|
/* Check if there are any new dots that should be placed in the list. */
|
|
for(p = ether_packets(); p != NULL; p = p->next) {
|
|
d = (struct dot *)memb_alloc(&dotsmem);
|
|
|
|
if(d != NULL) {
|
|
d->x = p->x;
|
|
d->y = p->y;
|
|
d->size = DOT_SIZE;
|
|
d->intensity = DOT_INTENSITY;
|
|
list_push(dots, d);
|
|
}
|
|
}
|
|
}
|
|
/*-----------------------------------------------------------------------------------*/
|
|
static gint
|
|
configure_event(GtkWidget *widget, GdkEventConfigure *event)
|
|
{
|
|
if(pixmap != NULL) {
|
|
gdk_pixmap_unref(pixmap);
|
|
}
|
|
|
|
pixmap = gdk_pixmap_new(widget->window,
|
|
widget->allocation.width,
|
|
widget->allocation.height,
|
|
-1);
|
|
|
|
if(pixmap == NULL) {
|
|
printf("gdk_pixmap_new == NULL\n");
|
|
exit(1);
|
|
}
|
|
gdk_draw_rectangle(pixmap,
|
|
widget->style->black_gc,
|
|
TRUE,
|
|
0, 0,
|
|
widget->allocation.width,
|
|
widget->allocation.height);
|
|
/* draw_screen();*/
|
|
return TRUE;
|
|
}
|
|
|
|
/* Redraw the screen from the backing pixmap */
|
|
static gint
|
|
expose_event (GtkWidget * widget, GdkEventExpose * event)
|
|
{
|
|
/* draw_screen();*/
|
|
gdk_draw_pixmap(widget->window,
|
|
widget->style->fg_gc[GTK_WIDGET_STATE (widget)],
|
|
pixmap,
|
|
event->area.x, event->area.y,
|
|
event->area.x, event->area.y,
|
|
event->area.width, event->area.height);
|
|
return FALSE;
|
|
}
|
|
|
|
static gint
|
|
key_press_event (GtkWidget * widget, GdkEventKey * event)
|
|
{
|
|
/* if(event->keyval == GDK_Shift_L ||
|
|
event->keyval == GDK_Shift_R) {
|
|
return TRUE;
|
|
}
|
|
keys[lastkey] = event->keyval;
|
|
++lastkey;
|
|
if(lastkey >= NUMKEYS) {
|
|
lastkey = 0;
|
|
}*/
|
|
|
|
if(event->keyval == 'q') {
|
|
gtk_exit(0);
|
|
/* exit(0);*/
|
|
}
|
|
return TRUE;
|
|
}
|
|
|
|
static gint
|
|
key_release_event (GtkWidget * widget, GdkEventKey * event)
|
|
{
|
|
return TRUE;
|
|
}
|
|
|
|
static gint
|
|
button_press_event (GtkWidget * widget, GdkEventKey * event)
|
|
{
|
|
struct dot *d;
|
|
struct sensor_data s;
|
|
GdkModifierType state;
|
|
int x, y;
|
|
|
|
gdk_window_get_pointer (event->window, &x, &y, &state);
|
|
|
|
x = ((GdkEventButton*)event)->x / SCALE;
|
|
y = ((GdkEventButton*)event)->y / SCALE;
|
|
|
|
if(state & GDK_BUTTON1_MASK) {
|
|
d = (struct dot *)memb_alloc(&dotsmem);
|
|
|
|
if(d != NULL) {
|
|
d->x = x;
|
|
d->y = y;
|
|
d->size = sensor_strength();
|
|
d->intensity = DOT_INTENSITY - 2;
|
|
list_push(dots, d);
|
|
}
|
|
sensor_data_init(&s);
|
|
s.pir = 1;
|
|
s.button = 0;
|
|
s.vib = 0;
|
|
ether_send_sensor_data(&s, x, y, sensor_strength());
|
|
} else if(state & GDK_BUTTON2_MASK) {
|
|
sensor_data_init(&s);
|
|
s.pir = 0;
|
|
s.button = 1;
|
|
s.vib = 0;
|
|
if(marked_node != NULL) {
|
|
ether_send_sensor_data(&s, marked_node->x, marked_node->y, 1);
|
|
}
|
|
} else if(state & GDK_BUTTON3_MASK) {
|
|
sensor_data_init(&s);
|
|
s.pir = 0;
|
|
s.button = 0;
|
|
s.vib = 1;
|
|
if(marked_node != NULL) {
|
|
ether_send_sensor_data(&s, marked_node->x, marked_node->y, 1);
|
|
}
|
|
}
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
static gint
|
|
pointer_motion_event (GtkWidget * widget, GdkEventMotion * event)
|
|
{
|
|
struct dot *d;
|
|
struct sensor_data s;
|
|
GdkModifierType state;
|
|
|
|
int x, y;
|
|
struct nodes_node *node, *closest;
|
|
int nodex, nodey;
|
|
unsigned long dist;
|
|
int i;
|
|
|
|
if(event->is_hint) {
|
|
return TRUE;
|
|
}
|
|
|
|
gdk_window_get_pointer (event->window, &x, &y, &state);
|
|
x /= SCALE;
|
|
y /= SCALE;
|
|
|
|
|
|
if(state & GDK_BUTTON1_MASK) {
|
|
d = (struct dot *)memb_alloc(&dotsmem);
|
|
|
|
if(d != NULL) {
|
|
d->x = x;
|
|
d->y = y;
|
|
d->size = sensor_strength();
|
|
d->intensity = DOT_INTENSITY - 2;
|
|
list_push(dots, d);
|
|
}
|
|
sensor_data_init(&s);
|
|
s.pir = 1;
|
|
ether_send_sensor_data(&s, x, y, sensor_strength());
|
|
} else {
|
|
|
|
|
|
/* Find the closest node and mark it. */
|
|
closest = NULL;
|
|
dist = 0;
|
|
for(i = 0; i < nodes_num(); ++i) {
|
|
node = nodes_node(i);
|
|
nodex = node->x;
|
|
nodey = node->y;
|
|
|
|
if(closest == NULL ||
|
|
(x - nodex) * (x - nodex) + (y - nodey) * (y - nodey) < dist) {
|
|
dist = (x - nodex) * (x - nodex) + (y - nodey) * (y - nodey);
|
|
closest = node;
|
|
}
|
|
}
|
|
marked_node = closest;
|
|
}
|
|
return TRUE;
|
|
}
|
|
|
|
static void
|
|
quit(void)
|
|
{
|
|
gtk_exit(0);
|
|
}
|
|
/*-----------------------------------------------------------------------------------*/
|
|
static void (* idle)(void);
|
|
static gint
|
|
idle_callback(gpointer data)
|
|
{
|
|
idle();
|
|
return TRUE;
|
|
}
|
|
/*-----------------------------------------------------------------------------------*/
|
|
static GdkGC *
|
|
get_color(unsigned short r, unsigned short g, unsigned short b)
|
|
{
|
|
GdkGCValues values;
|
|
GdkColor color;
|
|
|
|
color.pixel = 0;
|
|
color.red = r;
|
|
color.green = g;
|
|
color.blue = b;
|
|
|
|
if(gdk_colormap_alloc_color(gdk_colormap_get_system(),
|
|
&color, FALSE, TRUE)) {
|
|
}
|
|
|
|
values.foreground = color;
|
|
|
|
return gdk_gc_new_with_values(drawing_area->window,
|
|
&values,
|
|
GDK_GC_FOREGROUND);
|
|
}
|
|
/*-----------------------------------------------------------------------------------*/
|
|
void
|
|
display_init(void (* idlefunc)(void), int time, int with_gui)
|
|
{
|
|
int i;
|
|
GtkWidget *window;
|
|
GtkWidget *vbox;
|
|
GdkGCValues values;
|
|
GdkColor color;
|
|
|
|
memb_init(&dotsmem);
|
|
list_init(dots);
|
|
list_init(tempdots);
|
|
|
|
gtk_init(NULL, NULL);
|
|
|
|
window = gtk_window_new(GTK_WINDOW_TOPLEVEL);
|
|
gtk_window_set_title(window, "Contiki simulation display");
|
|
|
|
vbox = gtk_vbox_new(FALSE, 0);
|
|
gtk_container_add(GTK_CONTAINER (window), vbox);
|
|
gtk_widget_show(vbox);
|
|
|
|
gtk_signal_connect(GTK_OBJECT (window), "destroy",
|
|
GTK_SIGNAL_FUNC (quit), NULL);
|
|
|
|
font = gdk_font_load("-*-courier-medium-r-*-*-12-*-*-*-*-*-iso8859-1");
|
|
|
|
/* Create the drawing area */
|
|
|
|
drawing_area = gtk_drawing_area_new();
|
|
gtk_drawing_area_size(GTK_DRAWING_AREA (drawing_area),
|
|
DISPLAY_WIDTH,
|
|
DISPLAY_HEIGHT);
|
|
gtk_box_pack_start(GTK_BOX(vbox), drawing_area, TRUE, TRUE, 0);
|
|
|
|
gtk_widget_show(drawing_area);
|
|
|
|
/* Signals used to handle backing pixmap */
|
|
|
|
gtk_signal_connect(GTK_OBJECT (drawing_area), "expose_event",
|
|
(GtkSignalFunc) expose_event, NULL);
|
|
gtk_signal_connect(GTK_OBJECT (drawing_area), "configure_event",
|
|
(GtkSignalFunc) configure_event, NULL);
|
|
|
|
/* Event signals */
|
|
|
|
gtk_signal_connect(GTK_OBJECT (window), "key_press_event",
|
|
(GtkSignalFunc) key_press_event, NULL);
|
|
gtk_signal_connect(GTK_OBJECT (window), "key_release_event",
|
|
(GtkSignalFunc) key_release_event, NULL);
|
|
|
|
gtk_signal_connect(GTK_OBJECT (window), "button_press_event",
|
|
(GtkSignalFunc) button_press_event, NULL);
|
|
|
|
gtk_signal_connect(GTK_OBJECT (window), "motion_notify_event",
|
|
(GtkSignalFunc) pointer_motion_event, NULL);
|
|
|
|
gtk_widget_set_events(drawing_area,GDK_KEY_PRESS_MASK
|
|
| GDK_KEY_RELEASE_MASK | GDK_BUTTON_PRESS_MASK
|
|
| GDK_POINTER_MOTION_MASK);
|
|
|
|
/* gtk_window_iconify(window);*/
|
|
if(with_gui) {
|
|
gtk_widget_show(window);
|
|
window_is_open = with_gui;
|
|
}
|
|
|
|
|
|
idle = idlefunc;
|
|
gtk_timeout_add(time, idle_callback, NULL);
|
|
|
|
if(with_gui) {
|
|
|
|
for(i = 0; i < DOT_INTENSITY; ++i) {
|
|
color.pixel = 0;
|
|
color.red = 0;
|
|
color.green = ((DOT_INTENSITY + 1) * 0xffff) / (i + 1);
|
|
color.blue = ((DOT_INTENSITY + 1) * 0xffff) / (i + 1);
|
|
|
|
if(gdk_colormap_alloc_color(gdk_colormap_get_system(),
|
|
&color, FALSE, TRUE)) {
|
|
}
|
|
|
|
values.foreground = color;
|
|
|
|
intensity_gcs[i] = gdk_gc_new_with_values(drawing_area->window, &values,
|
|
GDK_GC_FOREGROUND);
|
|
}
|
|
|
|
color.pixel = 0;
|
|
color.red = 0xbfff;
|
|
color.green = 0xbfff;
|
|
color.blue = 0xbfff;
|
|
|
|
if(gdk_colormap_alloc_color(gdk_colormap_get_system(),
|
|
&color, FALSE, TRUE)) {
|
|
}
|
|
|
|
values.foreground = color;
|
|
|
|
intensity_clusterhead = gdk_gc_new_with_values(drawing_area->window, &values,
|
|
GDK_GC_FOREGROUND);
|
|
|
|
color.pixel = 0;
|
|
color.red = 0xefff;
|
|
color.green = 0xefff;
|
|
color.blue = 0xefff;
|
|
|
|
if(gdk_colormap_alloc_color(gdk_colormap_get_system(),
|
|
&color, FALSE, TRUE)) {
|
|
}
|
|
|
|
values.foreground = color;
|
|
|
|
intensity_clusterhead_lightgray = gdk_gc_new_with_values(drawing_area->window, &values,
|
|
GDK_GC_FOREGROUND);
|
|
|
|
color.pixel = 0;
|
|
color.red = 0xffff;
|
|
color.green = 0;
|
|
color.blue = 0;
|
|
|
|
if(gdk_colormap_alloc_color(gdk_colormap_get_system(),
|
|
&color, FALSE, TRUE)) {
|
|
}
|
|
|
|
values.foreground = color;
|
|
|
|
intensity_clusterhead_red = gdk_gc_new_with_values(drawing_area->window, &values,
|
|
GDK_GC_FOREGROUND);
|
|
|
|
|
|
red = get_color(0xffff, 0, 0);
|
|
green = get_color(0, 0xffff, 0);
|
|
yellow = get_color(0xffff, 0xffff, 0);
|
|
black = get_color(0, 0, 0);
|
|
white = get_color(0xffff, 0xffff, 0xffff);
|
|
}
|
|
}
|
|
/*-----------------------------------------------------------------------------------*/
|
|
void
|
|
display_run(void)
|
|
{
|
|
gtk_main();
|
|
}
|
|
/*-----------------------------------------------------------------------------------*/
|