295 lines
7.4 KiB
C++
295 lines
7.4 KiB
C++
|
/*
|
||
|
|
* Copyright (C) 2012 The Android Open Source Project
|
||
|
|
*
|
||
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
||
|
|
* you may not use this file except in compliance with the License.
|
||
|
|
* You may obtain a copy of the License at
|
||
|
|
*
|
||
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
||
|
|
*
|
||
|
|
* Unless required by applicable law or agreed to in writing, software
|
||
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
||
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||
|
|
* See the License for the specific language governing permissions and
|
||
|
|
* limitations under the License.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <stdint.h>
|
||
|
|
#include <sys/types.h>
|
||
|
|
|
||
|
|
#include <fcntl.h>
|
||
|
|
#include <sys/ioctl.h>
|
||
|
|
#include <linux/fb.h>
|
||
|
|
#include <linux/input.h>
|
||
|
|
#include <errno.h>
|
||
|
|
#include <string.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <cutils/memory.h>
|
||
|
|
#include <asm-generic/mman.h>
|
||
|
|
#include <sys/mman.h>
|
||
|
|
#include <utils/threads.h>
|
||
|
|
#include <unistd.h>
|
||
|
|
#include <math.h>
|
||
|
|
|
||
|
|
using namespace android;
|
||
|
|
|
||
|
|
#ifndef FBIO_WAITFORVSYNC
|
||
|
|
#define FBIO_WAITFORVSYNC _IOW('F', 0x20, __u32)
|
||
|
|
#endif
|
||
|
|
|
||
|
|
struct Buffer {
|
||
|
|
size_t w;
|
||
|
|
size_t h;
|
||
|
|
size_t s;
|
||
|
|
union {
|
||
|
|
void* addr;
|
||
|
|
uint32_t* pixels;
|
||
|
|
};
|
||
|
|
};
|
||
|
|
|
||
|
|
void clearBuffer(Buffer* buf, uint32_t pixel) {
|
||
|
|
android_memset32(buf->pixels, pixel, buf->s * buf->h * 4);
|
||
|
|
}
|
||
|
|
|
||
|
|
void drawTwoPixels(Buffer* buf, uint32_t pixel, ssize_t x, ssize_t y, size_t w) {
|
||
|
|
if (y>0 && y<ssize_t(buf->h)) {
|
||
|
|
uint32_t* bits = buf->pixels + y * buf->s;
|
||
|
|
if (x>=0 && x<buf->w) {
|
||
|
|
bits[x] = pixel;
|
||
|
|
}
|
||
|
|
ssize_t W(w);
|
||
|
|
if ((x+W)>=0 && (x+W)<buf->w) {
|
||
|
|
bits[x+W] = pixel;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void drawHLine(Buffer* buf, uint32_t pixel, ssize_t x, ssize_t y, size_t w) {
|
||
|
|
if (y>0 && y<ssize_t(buf->h)) {
|
||
|
|
ssize_t W(w);
|
||
|
|
if (x<0) {
|
||
|
|
W += x;
|
||
|
|
x = 0;
|
||
|
|
}
|
||
|
|
if (x+w > buf->w) {
|
||
|
|
W = buf->w - x;
|
||
|
|
}
|
||
|
|
if (W>0) {
|
||
|
|
uint32_t* bits = buf->pixels + y * buf->s + x;
|
||
|
|
android_memset32(bits, pixel, W*4);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void drawRect(Buffer* buf, uint32_t pixel, ssize_t x, ssize_t y, size_t w, size_t h) {
|
||
|
|
ssize_t W(w), H(h);
|
||
|
|
if (x<0) {
|
||
|
|
w += x;
|
||
|
|
x = 0;
|
||
|
|
}
|
||
|
|
if (y<0) {
|
||
|
|
h += y;
|
||
|
|
y = 0;
|
||
|
|
}
|
||
|
|
if (x+w > buf->w) W = buf->w - x;
|
||
|
|
if (y+h > buf->h) H = buf->h - y;
|
||
|
|
if (W>0 && H>0) {
|
||
|
|
uint32_t* bits = buf->pixels + y * buf->s + x;
|
||
|
|
for (ssize_t i=0 ; i<H ; i++) {
|
||
|
|
android_memset32(bits, pixel, W*4);
|
||
|
|
bits += buf->s;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void drawCircle(Buffer* buf, uint32_t pixel,
|
||
|
|
size_t x0, size_t y0, size_t radius, bool filled = false) {
|
||
|
|
ssize_t f = 1 - radius;
|
||
|
|
ssize_t ddF_x = 1;
|
||
|
|
ssize_t ddF_y = -2 * radius;
|
||
|
|
ssize_t x = 0;
|
||
|
|
ssize_t y = radius;
|
||
|
|
if (filled) {
|
||
|
|
drawHLine(buf, pixel, x0-radius, y0, 2*radius);
|
||
|
|
} else {
|
||
|
|
drawTwoPixels(buf, pixel, x0-radius, y0, 2*radius);
|
||
|
|
}
|
||
|
|
while (x < y) {
|
||
|
|
if (f >= 0) {
|
||
|
|
y--;
|
||
|
|
ddF_y += 2;
|
||
|
|
f += ddF_y;
|
||
|
|
}
|
||
|
|
x++;
|
||
|
|
ddF_x += 2;
|
||
|
|
f += ddF_x;
|
||
|
|
if (filled) {
|
||
|
|
drawHLine(buf, pixel, x0-x, y0+y, 2*x);
|
||
|
|
drawHLine(buf, pixel, x0-x, y0-y, 2*x);
|
||
|
|
drawHLine(buf, pixel, x0-y, y0+x, 2*y);
|
||
|
|
drawHLine(buf, pixel, x0-y, y0-x, 2*y);
|
||
|
|
} else {
|
||
|
|
drawTwoPixels(buf, pixel, x0-x, y0+y, 2*x);
|
||
|
|
drawTwoPixels(buf, pixel, x0-x, y0-y, 2*x);
|
||
|
|
drawTwoPixels(buf, pixel, x0-y, y0+x, 2*y);
|
||
|
|
drawTwoPixels(buf, pixel, x0-y, y0-x, 2*y);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
class TouchEvents {
|
||
|
|
class EventThread : public Thread {
|
||
|
|
int fd;
|
||
|
|
|
||
|
|
virtual bool threadLoop() {
|
||
|
|
input_event event;
|
||
|
|
int first_down = 0;
|
||
|
|
do {
|
||
|
|
read(fd, &event, sizeof(event));
|
||
|
|
if (event.type == EV_ABS) {
|
||
|
|
if (event.code == ABS_MT_TRACKING_ID) {
|
||
|
|
down = event.value == -1 ? 0 : 1;
|
||
|
|
first_down = down;
|
||
|
|
}
|
||
|
|
if (event.code == ABS_MT_POSITION_X) {
|
||
|
|
x = event.value;
|
||
|
|
}
|
||
|
|
if (event.code == ABS_MT_POSITION_Y) {
|
||
|
|
y = event.value;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
} while (event.type == EV_SYN);
|
||
|
|
return true;
|
||
|
|
}
|
||
|
|
|
||
|
|
public:
|
||
|
|
int x, y, down;
|
||
|
|
EventThread() : Thread(false),
|
||
|
|
x(0), y(0), down(0)
|
||
|
|
{
|
||
|
|
fd = open("/dev/input/event1", O_RDONLY);
|
||
|
|
}
|
||
|
|
};
|
||
|
|
sp<EventThread> thread;
|
||
|
|
|
||
|
|
public:
|
||
|
|
TouchEvents() {
|
||
|
|
thread = new EventThread();
|
||
|
|
thread->run("EventThread", PRIORITY_URGENT_DISPLAY);
|
||
|
|
}
|
||
|
|
|
||
|
|
int getMostRecentPosition(int* x, int* y) {
|
||
|
|
*x = thread->x;
|
||
|
|
*y = thread->y;
|
||
|
|
return thread->down;
|
||
|
|
}
|
||
|
|
};
|
||
|
|
|
||
|
|
|
||
|
|
struct Queue {
|
||
|
|
struct position {
|
||
|
|
int x, y;
|
||
|
|
};
|
||
|
|
int index;
|
||
|
|
position q[16];
|
||
|
|
Queue() : index(0) { }
|
||
|
|
void push(int x, int y) {
|
||
|
|
index++;
|
||
|
|
index &= 0xF;
|
||
|
|
q[index].x = x;
|
||
|
|
q[index].y = y;
|
||
|
|
}
|
||
|
|
void get(int lag, int* x, int* y) {
|
||
|
|
const int i = (index - lag) & 0xF;
|
||
|
|
*x = q[i].x;
|
||
|
|
*y = q[i].y;
|
||
|
|
}
|
||
|
|
};
|
||
|
|
|
||
|
|
extern char *optarg;
|
||
|
|
extern int optind;
|
||
|
|
extern int optopt;
|
||
|
|
extern int opterr;
|
||
|
|
extern int optreset;
|
||
|
|
|
||
|
|
void usage(const char* name) {
|
||
|
|
printf("\nusage: %s [-h] [-l lag]\n", name);
|
||
|
|
}
|
||
|
|
|
||
|
|
int main(int argc, char** argv) {
|
||
|
|
fb_var_screeninfo vi;
|
||
|
|
fb_fix_screeninfo fi;
|
||
|
|
|
||
|
|
int lag = 0;
|
||
|
|
int fd = open("/dev/graphics/fb0", O_RDWR);
|
||
|
|
ioctl(fd, FBIOGET_VSCREENINFO, &vi);
|
||
|
|
ioctl(fd, FBIOGET_FSCREENINFO, &fi);
|
||
|
|
void* bits = mmap(0, fi.smem_len, PROT_READ | PROT_WRITE, MAP_SHARED, fd, 0);
|
||
|
|
Buffer framebuffer;
|
||
|
|
framebuffer.w = vi.xres;
|
||
|
|
framebuffer.h = vi.yres;
|
||
|
|
framebuffer.s = fi.line_length / (vi.bits_per_pixel >> 3);
|
||
|
|
framebuffer.addr = bits;
|
||
|
|
|
||
|
|
int ch;
|
||
|
|
while ((ch = getopt(argc, argv, "hl:")) != -1) {
|
||
|
|
switch (ch) {
|
||
|
|
case 'l':
|
||
|
|
lag = atoi(optarg);
|
||
|
|
break;
|
||
|
|
case 'h':
|
||
|
|
default:
|
||
|
|
usage(argv[0]);
|
||
|
|
exit(0);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
argc -= optind;
|
||
|
|
argv += optind;
|
||
|
|
|
||
|
|
|
||
|
|
TouchEvents touch;
|
||
|
|
Queue queue;
|
||
|
|
|
||
|
|
|
||
|
|
int x=0, y=0, down=0;
|
||
|
|
int lag_x=0, lag_y=0;
|
||
|
|
|
||
|
|
clearBuffer(&framebuffer, 0);
|
||
|
|
while (true) {
|
||
|
|
uint32_t crt = 0;
|
||
|
|
int err = ioctl(fd, FBIO_WAITFORVSYNC, &crt);
|
||
|
|
|
||
|
|
// draw beam marker
|
||
|
|
drawRect(&framebuffer, 0x400000, framebuffer.w-2, 0, 2, framebuffer.h);
|
||
|
|
// erase screen
|
||
|
|
if (lag) {
|
||
|
|
drawCircle(&framebuffer, 0, lag_x, lag_y, 100);
|
||
|
|
drawHLine(&framebuffer, 0, 0, lag_y, 32);
|
||
|
|
}
|
||
|
|
drawCircle(&framebuffer, 0, x, y, 100, true);
|
||
|
|
drawHLine(&framebuffer, 0, 0, y, 32);
|
||
|
|
|
||
|
|
// draw a line at y=1000
|
||
|
|
drawHLine(&framebuffer, 0x808080, 0, 1000, framebuffer.w);
|
||
|
|
|
||
|
|
// get touch events
|
||
|
|
touch.getMostRecentPosition(&x, &y);
|
||
|
|
queue.push(x, y);
|
||
|
|
queue.get(lag, &lag_x, &lag_y);
|
||
|
|
|
||
|
|
if (lag) {
|
||
|
|
drawCircle(&framebuffer, 0x00FF00, lag_x, lag_y, 100);
|
||
|
|
drawHLine(&framebuffer, 0x00FF00, 0, lag_y, 32);
|
||
|
|
}
|
||
|
|
|
||
|
|
drawCircle(&framebuffer, 0xFFFFFF, x, y, 100, true);
|
||
|
|
drawHLine(&framebuffer, 0xFFFFFF, 0, y, 32);
|
||
|
|
|
||
|
|
// draw end of frame beam marker
|
||
|
|
drawRect(&framebuffer, 0x004000, framebuffer.w-2, 0, 2, framebuffer.h);
|
||
|
|
}
|
||
|
|
|
||
|
|
close(fd);
|
||
|
|
return 0;
|
||
|
|
}
|