#include <Adafruit_SSD1306.h>

#define DISPLAY_I2C_ADDRESS 0x3C
#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64

#define D1_I2C_SDA 21
#define D1_I2C_SCL 5

#define D2_I2C_SDA 19 //19
#define D2_I2C_SCL 18 //18

//Adafruit_SSD1306 display1(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, -1);
//Adafruit_SSD1306 display2(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire1, -1);

void initDisplay();
void drawPoint(int displayId, int x, int y);
void display2BorderDebug();
void rads(int16_t x, int16_t y, int radius, float rad);
void radsCalc(int16_t x, int16_t y, int radius, float radSin, float radCos);
void display2Border();
void display2DrawSenseLine(float value);