void LCD_Line(unsigned char x0, unsigned char y0, unsigned char x1, unsigned char y1, int color) {
int dy = y1 - y0;
int dx = x1 - x0;
int stepx, stepy;
if (dy < 0) { dy = -dy; stepy = -1; } else { stepy = 1; }
if (dx < 0) { dx = -dx; stepx = -1; } else { stepx = 1; }
dy <<= 1; // dy is now 2*dy
dx <<= 1; // dx is now 2*dx
LCD_Pixel(x0, y0, color);
if (dx > dy) {
int fraction = dy - (dx >> 1); // same as 2*dy - dx
while (x0 != x1) {
if (fraction >= 0) {
y0 += stepy;
fraction -= dx; // same as fraction -= 2*dx
}
x0 += stepx;
fraction += dy; // same as fraction -= 2*dy
LCD_Pixel(x0, y0, color);
}
}
void LCD_Circle(int x0, int y0, int r, int color)
{
int x = -r, y = 0, err = 2-2*r, e2;
do {
LCD_Pixel(x0-x, y0+y,color);
LCD_Pixel(x0+x, y0+y,color);
LCD_Pixel(x0+x, y0-y,color);
LCD_Pixel(x0-x, y0-y,color);
e2 = err;
if (e2 <= y) {
err += ++y*2+1;
if (-x == y && e2 <= x) e2 = 0;
}
if (e2 > x) err += ++x*2+1;
} while (x <= 0);
}
void draw_clock_frame() {
LCD_HorizontalLine(12, 2, 79, BLACK);
LCD_HorizontalLine(33, 2, 80, BLACK);
LCD_HorizontalLine(34, 3, 81, BLACK);
LCD_HorizontalLine(35, 4, 81, BLACK);
LCD_VerticalLine(1, 13, 32, BLACK);
LCD_VerticalLine(80, 13, 32, BLACK);
LCD_VerticalLine(81, 14, 33, BLACK);
LCD_VerticalLine(82, 15, 34, BLACK);
LCD_Pixel(2, 13, BLACK);
LCD_Pixel(2, 32, BLACK);
LCD_Pixel(79, 13, BLACK);
LCD_Pixel(79, 32, BLACK);
}
void Nokia_lcd::pixel(){
LCD_Pixel(_x, _y, _color);
}
/* main work function */
void work(void) {
unsigned short i, j;
unsigned char mailbox_num = 0;
volatile ProtoIOMBox * mbox;
/* setup status */
status_setup();
/* setup serial console */
usart1_setup();
/* setup proto */
proto_setup();
mbox = proto_srv_dat.mailboxes[mailbox_num];
/* setup button */
buttons_setup();
/* lcd setup */
LCD_Setup();
LCD_Clear(BLACK);
for (i = 0; i < 10; i++) {
for (j = 0; j < 10; j++) {
LCD_Pixel(j + 10, i + 10, test.data[i * 10 + j]);
}
}
LCD_Window(0, 0, 9, 9);
LCD_RS_LOW;
LCD_SELECT;
for (i = 0; i < 100; i++) {
LCD_Send(test.data[i] >> 8);
LCD_Send(test.data[i] & 0x00ff);
}
LCD_Cursor(0, 0);
LCD_DESEL;
/* check status */
check_status();
/* send ping */
mbox->outbox->header = 'C'; /* Command */
mbox->outbox->size = 0x00; /* 0 for ping request */
mbox->outbox_s = PROTO_IO_MBOX_READY; /* Box ready */
mbox->inbox->size = 64; /* buffer len for control */
mbox->inbox_s = PROTO_IO_MBOX_READY; /* Box ready */
/* wait connection estabilished */
while (status == 0);
/* send ping message */
proto_send_msg(mailbox_num);
/* wait to send message */
while (mbox->outbox_s <= PROTO_IO_MBOX_SEND);
if (mbox->outbox_s == PROTO_IO_MBOX_COMPLETE)
LCD_String("Con", 36, 6, 1, WHITE, GLASSY);
else
LCD_String("Un", 36, 6, 1, RED, GLASSY);
/* get ping message */
/* FIXME wtf? this not work or work parity */
//proto_get_msg(mailbox_num);
/* wait to get message */
while (mbox->inbox_s <= PROTO_IO_MBOX_SEND);
if (mbox->inbox_s == PROTO_IO_MBOX_COMPLETE) {
LCD_String("OK", 36 + 3 * 7, 6, 1, GREEN, GLASSY);
for (i = 0; i < mbox->inbox->size; i++)
LCD_Char(mbox->inbox->message[i], 70 + i * 6, 6, 1, WHITE, GLASSY);
}
else
LCD_String("ERR", 36 + 3 * 7, 6, 1, RED, GLASSY);
/* infinity loop */
while (1) {
if (button_state.state[B_LGHT] == B_CLICK) {
sender('+');
button_state.state[B_LGHT] = B_RELEASE;
}
if (button_state.state[B_MOD] == B_CLICK) {
sender('m');
button_state.state[B_MOD] = B_RELEASE;
}
if (button_state.state[B_SET] == B_CLICK) {
sender('-');
button_state.state[B_SET] = B_RELEASE;
}
if (button_state.state[B_UP] == B_CLICK) {
sender('<');
button_state.state[B_UP] = B_RELEASE;
}
if (button_state.state[B_SU] == B_CLICK) {
sender('p');
button_state.state[B_SU] = B_RELEASE;
}
if (button_state.state[B_DWN] == B_CLICK) {
sender('>');
button_state.state[B_DWN] = B_RELEASE;
}
}
}
void Nokia_lcd::cLCD_Pixel(unsigned char x, unsigned char y, int color){
LCD_Pixel(x,y,color);
}
void LCD_Line(int x0, int y0, int x1, int y1, int color)
{
int dx = 0, dy = 0;
int dx_sym = 0, dy_sym = 0;
int dx_x2 = 0, dy_x2 = 0;
int di = 0;
dx = x1-x0;
dy = y1-y0;
if (dx == 0) { /* vertical line */
if (y1 > y0) LCD_Vline(x0,y0,y1,color);
else LCD_Vline(x0,y1,y0,color);
return;
}
if (dx > 0) {
dx_sym = 1;
} else {
dx_sym = -1;
}
if (dy == 0) { /* horizontal line */
if (x1 > x0) LCD_Hline(x0,x1,y0,color);
else LCD_Hline(x1,x0,y0,color);
return;
}
if (dy > 0) {
dy_sym = 1;
} else {
dy_sym = -1;
}
dx = dx_sym*dx;
dy = dy_sym*dy;
dx_x2 = dx*2;
dy_x2 = dy*2;
if (dx >= dy) {
di = dy_x2 - dx;
while (x0 != x1) {
LCD_Pixel(x0, y0, color);
x0 += dx_sym;
if (di<0) {
di += dy_x2;
} else {
di += dy_x2 - dx_x2;
y0 += dy_sym;
}
}
LCD_Pixel(x0, y0, color);
} else {
di = dx_x2 - dy;
while (y0 != y1) {
LCD_Pixel(x0, y0, color);
y0 += dy_sym;
if (di < 0) {
di += dx_x2;
} else {
di += dx_x2 - dy_x2;
x0 += dx_sym;
}
}
LCD_Pixel(x0, y0, color);
}
return;
}
