#include "libOLED/displayXY.H"
const unsigned MARGIN = 1;
const unsigned BOTTOM_MARGIN = 17;
displayXY_t ::displayXY_t(display_t &disp,
int xmin, int xmax, int ymin, int ymax) : display(disp), x_min(xmin), x_max(xmax), y_min(ymin), y_max(ymax),
left_margin(MARGIN), right_margin(display.width() - MARGIN), plot_width(right_margin - left_margin),
top_margin(MARGIN), bottom_margin(display.height() - BOTTOM_MARGIN), plot_height(bottom_margin - top_margin), next_persist(0)
{
for (uint16_t i = 0; i < PERSIST; i++)
{
persist_x[i] = left_margin;
persist_y[i] = bottom_margin;
}
};
void displayXY_t ::drawAxes()
{
display.drawLine(left_margin, bottom_margin, right_margin, bottom_margin,
WHITE, 0b10);
display.drawLine(left_margin, bottom_margin, left_margin, top_margin, WHITE, 0b10);
}
void displayXY_t ::plotPoint(int x, int y, char *message,char * message_lower, char * message_upper)
{
int y_coord = (plot_height * (y - y_min)) / (y_max - y_min);
int x_coord = (plot_width * (x - x_min)) / (x_max - x_min);
display.drawLine(left_margin, y_coord, right_margin, y_coord, WHITE, 0b111000);
display.drawLine(x_coord, top_margin, x_coord, bottom_margin, WHITE, 0b111000);
persist_x[next_persist] = x_coord;
persist_y[next_persist] = y_coord;
next_persist++;
if (next_persist > PERSIST)
next_persist = 0;
for (uint16_t i = 0; i < PERSIST; i++)
{
display.drawPixel(persist_x[i], persist_y[i], WHITE);
}
if(message)
{
display.gotoxy(0, 48);
display.printString(large_font, message, 0, OVERLAY);
}
if (message_upper)
{
display.gotoxy(56,48);
display.printString(small_font, message_upper, 0, OVERLAY);
}
if (message_lower)
{
display.gotoxy(56,56);
display.printString(small_font, message_lower, 0, OVERLAY);
}
}