WebSVN – libOLED – Blame – /trunk/src/displayDial.cpp

Rev	Author	Line No.	Line
4	mjames	1	/*
		2	* dials.c
		3	*
		4	* Created on: 22 Jan 2016
		5	* Author: Mike
		6	*/
		7
		8	#include "libOLED/ap_math.H"
		9	#include "libOLED/displayclass.H"
		10	#include "libOLED/fontclass.H"
		11	#include "libOLED/displayDial.H"
16	mjames	12	#include <string.h>
4	mjames	13
		14	static ap_math math;
		15
16	mjames	16	displayDial_t::displayDial_t(display_t &display, uint8_t x, uint8_t y, uint8_t siz, int16_t angle_low, int16_t angle_high) : m_display(display),
		17	m_xo(x), m_yo(y), m_siz(siz), m_angleLow(angle_low), m_angleRange(angle_high - angle_low), m_unitStr(nullptr)
4	mjames	18	{
		19	}
		20
16	mjames	21	displayDial_t::displayDial_t(display_t &display, uint8_t x, uint8_t y, uint8_t siz, uint16_t angle_) : m_display(display), m_xo(x), m_yo(y), m_siz(siz), m_angleLow(-angle_), m_angleRange(2 * angle_), m_unitStr(nullptr)
14	mjames	22	{
16	mjames	23	}
14	mjames	24
4	mjames	25	/* position is integer from 0 to SINE_STEPS */
10	mjames	26	void displayDial_t::draw_needle(int16_t position)
4	mjames	27	{
14	mjames	28	// int ang = math.SINE_SCALING * ((position - (math.SINE_STEPS / 2)) * m_a1) / (math.SINE_STEPS / 2);
		29	int ang = (math.SINE_SCALING * position * m_angleRange) / math.SINE_STEPS + m_angleLow * math.SINE_SCALING;
10	mjames	30	int si = math.ap_sin(ang);
		31	int co = math.ap_cos(ang);
4	mjames	32
15	mjames	33	/* calculate an orthogonal XY shift for a second side of the needle */
10	mjames	34	int xl = math.ap_sin(ang - math.SINE_STEPS);
		35	int yl = math.ap_cos(ang - math.SINE_STEPS);
4	mjames	36
		37	int si2 = m_siz + 2;
		38	int si3 = 2 * m_siz / 3;
		39
10	mjames	40	int xs, ys;
4	mjames	41	// three parallel lines
		42	xs = -xl;
		43	ys = -yl;
		44	int step;
10	mjames	45	for (step = 0; step < 3; step++)
		46	{
		47	m_display.drawLine(math.AP_SCALE(si * si2 - xs) + m_xo, m_yo - math.AP_SCALE(co * si2 - ys),
		48	math.AP_SCALE(si * si3 - xs) + m_xo, m_yo - math.AP_SCALE(co * si3 - ys), INVERT);
		49	xs += xl;
		50	ys += yl;
		51	}
		52	}
4	mjames	53
10	mjames	54	void displayDial_t::draw_scale(int16_t low, int16_t high, uint8_t width, uint8_t num_step, int16_t scale)
4	mjames	55	{
5	mjames	56
4	mjames	57	int ang;
7	mjames	58	m_low = low;
		59	m_high = high;
10	mjames	60	int sc_low = low / scale;
		61	int sc_high = high / scale;
14	mjames	62	int step = 256 * m_angleRange / (4 * (sc_high - sc_low));
4	mjames	63	int t;
14	mjames	64	ang = m_angleLow * 256;
16	mjames	65	int d = sc_low < sc_high ? 1 : -1;
14	mjames	66	t = sc_low * 4;
16	mjames	67	while (1)
10	mjames	68	{
		69	int si = math.ap_sin((ang * math.SINE_SCALING) / 256);
		70	int co = math.ap_cos((ang * math.SINE_SCALING) / 256);
		71
		72	int len;
		73	switch (t % 4)
4	mjames	74	{
10	mjames	75	case 0:
		76	len = width;
		77	break;
		78	case 1:
		79	case 3:
		80	case -1:
		81	case -3:
		82	len = width / 4;
		83	break;
		84	case 2:
		85	case -2:
		86	len = width / 2;
		87	break;
4	mjames	88	}
		89
10	mjames	90	m_display.drawLine(math.AP_SCALE((m_siz)si) + m_xo, m_yo - math.AP_SCALE((m_siz)co),
		91	math.AP_SCALE((m_siz - len) * si) + m_xo,
		92	m_yo - math.AP_SCALE((m_siz - len) * co), WHITE);
16	mjames	93
		94	if (t == sc_high * 4)
		95	break;
		96
10	mjames	97	ang += step;
14	mjames	98	t += d;
10	mjames	99	}
4	mjames	100	}
7	mjames	101
16	mjames	102	void displayDial_t::draw_value_items(int val, int dpCode, int width, int x, int y)
7	mjames	103	{
16	mjames	104
		105	m_display.gotoxy(x, y);
		106	m_display.fontDigits(large_font, width, dpCode, val, WHITE);
		107	m_display.gotoxy(x, y+16);
		108	if (m_unitStr)
		109	{
		110	int l = strlen(m_unitStr);
		111	if (l > 4)
		112	l = 4;
		113	m_display.printString(small_font, m_unitStr, l);
		114	m_display.printString(small_font, " ", 4 - l);
		115	}
		116	else
		117	{
		118	m_display.printString(small_font, " ", 4);
		119	}
		120	}
		121
		122	////////////////////////////////////////////////////////////////////////////////
		123	displayFullDial_t::displayFullDial_t(display_t &display) : displayDial_t(display, 64, 60, 60, 90)
		124	{
		125	}
		126
		127	void displayFullDial_t::draw_limits()
		128	{
10	mjames	129	m_display.fontSigDigits(small_font, 0, 56, 0, 10, m_low, WHITE);
		130	m_display.fontSigDigits(small_font, 120, 56, 1, 10, m_high, WHITE);
7	mjames	131	}
16	mjames	132
		133	void displayFullDial_t ::draw_value(int val, int dp)
		134	{
		135	draw_value_items(val, dp, 4, 30, 32);
		136	}
		137
		138	////////////////////////////////////////////////////////////////////////////////
		139	displayLeftQuadrantDial_t::displayLeftQuadrantDial_t(display_t &display) : displayDial_t(display, 0, 60, 60, 90, 0){};
		140
		141	void displayLeftQuadrantDial_t::draw_limits()
		142	{
		143	m_display.fontSigDigits(small_font, 0, 10, false, display_t::NO_DECIMAL, m_high, WHITE);
		144	m_display.fontSigDigits(small_font, 56, 56, true, display_t::NO_DECIMAL, m_low, WHITE);
		145	}
		146
		147	void displayLeftQuadrantDial_t ::draw_value(int val, int dp)
		148	{
		149	draw_value_items(val, dp, 3, 0, 32);
		150	}
		151
		152	////////////////////////////////////////////////////////////////////////////////
		153	displayRightQuadrantDial_t::displayRightQuadrantDial_t(display_t &display) : displayDial_t(display, 127, 60, 60, -90, 0){};
		154
		155	void displayRightQuadrantDial_t::draw_limits()
		156	{
		157	m_display.fontSigDigits(small_font, 128, 10, true, display_t::NO_DECIMAL, m_high, WHITE);
		158	m_display.fontSigDigits(small_font, 128 - 56, 56, false, display_t::NO_DECIMAL, m_low, WHITE);
		159	}
		160
		161	void displayRightQuadrantDial_t::draw_value(int val, int dp)
		162	{
		163	draw_value_items(val, dp, 3, 90, 32);
		164	}

Subversion Repositories libOLED

(root)/trunk/src/displayDial.cpp – Rev 16