2 files changed, 63 insertions, 0 deletions
diff --git a/graph.c b/graph.c
new file mode 100644
index 00000000..440f2507
--- /dev/null
+++ b/graph.c
@@ -0,0 +1,55 @@
+#include "glcd.h"
+
+#define GRID_X		20
+#define GRID_Y		20
+
+#define MARKSIZE	5 	// half
+
+static uint16_t x, y;	// origins in graph
+
+void graphDrawSystem(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t color) {
+	uint16_t i, length;
+	volatile uint16_t off;
+
+	x = x0;
+	y = y0;
+
+	// X-Axis
+	length = x1 - x0;
+	lcdDrawLine(x0, y0, x1, y0, color);
+	lcdDrawLine(x1, y0, x1-5, y0+5, color);
+	lcdDrawLine(x1, y0, x1-5, y0-5, color);	
+	for(i=1; i<(length / GRID_X); i++) {
+		off = x0 + i*GRID_X;
+		lcdDrawLine(off, y0-MARKSIZE, off, y0+MARKSIZE, color);
+	}
+
+	// Y-Axis
+	length = y0 - y1;
+	lcdDrawLine(x0, y0, x0, y1, color);
+	lcdDrawLine(x0, y1, x0-5, y1+5, color);
+	lcdDrawLine(x0, y1, x0+5, y1+5, color);
+	for(i=1; i<(length / GRID_Y); i++) {
+		off = x0 + i*GRID_Y;
+		lcdDrawLine(x0-MARKSIZE, off, x0+MARKSIZE, off, color);	
+	}
+}
+
+void graphDrawDots(int16_t coord[][2], uint16_t entries, uint16_t radius, uint16_t color) {
+	uint16_t i;
+
+	for(i=0; i<entries; i++)
+		lcdDrawCircle(coord[i][0]+x, y-coord[i][1], radius, 1, color);
+}
+
+void graphDrawNet(int16_t coord[][2], uint16_t entries, uint16_t radius, uint16_t lineColor, uint16_t dotColor) {
+	uint16_t i;
+
+	for(i = 0; i < entries; ++i)
+		lcdDrawLine(coord[i-1][0]+x, y-coord[i-1][1], coord[i][0]+x, y-coord[i][1], lineColor); 
+	for(i=0; i<entries; ++i)
+		if(radius != 0)
+			lcdDrawCircle(coord[i][0]+x, y-coord[i][1], radius, 1, dotColor);
+}
+
+
diff --git a/graph.h b/graph.h
new file mode 100644
index 00000000..14fd20de
--- /dev/null
+++ b/graph.h
@@ -0,0 +1,8 @@
+#ifndef GRAPH_H
+#define GRAPH_H
+
+void graphDrawSystem(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t color);
+void graphDrawDots(int16_t coord[][2], uint16_t entries, uint16_t radius, uint16_t color);
+void graphDrawNet(int16_t coord[][2], uint16_t entries, uint16_t radisu, uint16_t lineColor, uint16_t dotColor);
+
+#endif