mirror of
https://gitlab.freedesktop.org/wayland/weston
synced 2024-09-06 18:05:39 +00:00
![Jon Cruz](/assets/img/avatar_default.png)
To help reduce code duplication and also 'kitchen-sink' includes the ARRAY_LENGTH macro was moved to a stand-alone file and referenced from the sources consuming it. Other macros will be added in subsequent passes. Signed-off-by: Jon A. Cruz <jonc@osg.samsung.com> Reviewed-by: Peter Hutterer <peter.hutterer@who-t.net> Reviewed-by: Bryce Harrington <bryce@osg.samsung.com>
280 lines
6.9 KiB
C
280 lines
6.9 KiB
C
/*
|
|
* Copyright © 2012 Intel Corporation
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a
|
|
* copy of this software and associated documentation files (the "Software"),
|
|
* to deal in the Software without restriction, including without limitation
|
|
* the rights to use, copy, modify, merge, publish, distribute, sublicense,
|
|
* and/or sell copies of the Software, and to permit persons to whom the
|
|
* Software is furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice (including the next
|
|
* paragraph) shall be included in all copies or substantial portions of the
|
|
* Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
|
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
|
|
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
|
|
* DEALINGS IN THE SOFTWARE.
|
|
*/
|
|
|
|
#include "config.h"
|
|
|
|
#include <stdint.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <cairo.h>
|
|
#include <math.h>
|
|
#include <assert.h>
|
|
|
|
#include <linux/input.h>
|
|
#include <wayland-client.h>
|
|
|
|
#include "window.h"
|
|
#include "shared/helpers.h"
|
|
#include "shared/matrix.h"
|
|
|
|
/* Our points for the calibration must be not be on a line */
|
|
static const struct {
|
|
float x_ratio, y_ratio;
|
|
} test_ratios[] = {
|
|
{ 0.20, 0.40 },
|
|
{ 0.80, 0.60 },
|
|
{ 0.40, 0.80 }
|
|
};
|
|
|
|
struct calibrator {
|
|
struct tests {
|
|
int32_t drawn_x, drawn_y;
|
|
int32_t clicked_x, clicked_y;
|
|
} tests[ARRAY_LENGTH(test_ratios)];
|
|
int current_test;
|
|
|
|
struct display *display;
|
|
struct window *window;
|
|
struct widget *widget;
|
|
};
|
|
|
|
/*
|
|
* Calibration algorithm:
|
|
*
|
|
* The equation we want to apply at event time where x' and y' are the
|
|
* calibrated co-ordinates.
|
|
*
|
|
* x' = Ax + By + C
|
|
* y' = Dx + Ey + F
|
|
*
|
|
* For example "zero calibration" would be A=1.0 B=0.0 C=0.0, D=0.0, E=1.0,
|
|
* and F=0.0.
|
|
*
|
|
* With 6 unknowns we need 6 equations to find the constants:
|
|
*
|
|
* x1' = Ax1 + By1 + C
|
|
* y1' = Dx1 + Ey1 + F
|
|
* ...
|
|
* x3' = Ax3 + By3 + C
|
|
* y3' = Dx3 + Ey3 + F
|
|
*
|
|
* In matrix form:
|
|
*
|
|
* x1' x1 y1 1 A
|
|
* x2' = x2 y2 1 x B
|
|
* x3' x3 y3 1 C
|
|
*
|
|
* So making the matrix M we can find the constants with:
|
|
*
|
|
* A x1'
|
|
* B = M^-1 x x2'
|
|
* C x3'
|
|
*
|
|
* (and similarly for D, E and F)
|
|
*
|
|
* For the calibration the desired values x, y are the same values at which
|
|
* we've drawn at.
|
|
*
|
|
*/
|
|
static void
|
|
finish_calibration (struct calibrator *calibrator)
|
|
{
|
|
struct weston_matrix m;
|
|
struct weston_matrix inverse;
|
|
struct weston_vector x_calib, y_calib;
|
|
int i;
|
|
|
|
|
|
/*
|
|
* x1 y1 1 0
|
|
* x2 y2 1 0
|
|
* x3 y3 1 0
|
|
* 0 0 0 1
|
|
*/
|
|
memset(&m, 0, sizeof(m));
|
|
for (i = 0; i < (int)ARRAY_LENGTH(test_ratios); i++) {
|
|
m.d[i] = calibrator->tests[i].clicked_x;
|
|
m.d[i + 4] = calibrator->tests[i].clicked_y;
|
|
m.d[i + 8] = 1;
|
|
}
|
|
m.d[15] = 1;
|
|
|
|
weston_matrix_invert(&inverse, &m);
|
|
|
|
memset(&x_calib, 0, sizeof(x_calib));
|
|
memset(&y_calib, 0, sizeof(y_calib));
|
|
|
|
for (i = 0; i < (int)ARRAY_LENGTH(test_ratios); i++) {
|
|
x_calib.f[i] = calibrator->tests[i].drawn_x;
|
|
y_calib.f[i] = calibrator->tests[i].drawn_y;
|
|
}
|
|
|
|
/* Multiples into the vector */
|
|
weston_matrix_transform(&inverse, &x_calib);
|
|
weston_matrix_transform(&inverse, &y_calib);
|
|
|
|
printf ("Calibration values: %f %f %f %f %f %f\n",
|
|
x_calib.f[0], x_calib.f[1], x_calib.f[2],
|
|
y_calib.f[0], y_calib.f[1], y_calib.f[2]);
|
|
|
|
exit(0);
|
|
}
|
|
|
|
|
|
static void
|
|
button_handler(struct widget *widget,
|
|
struct input *input, uint32_t time,
|
|
uint32_t button,
|
|
enum wl_pointer_button_state state, void *data)
|
|
{
|
|
struct calibrator *calibrator = data;
|
|
int32_t x, y;
|
|
|
|
if (state == WL_POINTER_BUTTON_STATE_PRESSED && button == BTN_LEFT) {
|
|
input_get_position(input, &x, &y);
|
|
calibrator->tests[calibrator->current_test].clicked_x = x;
|
|
calibrator->tests[calibrator->current_test].clicked_y = y;
|
|
|
|
calibrator->current_test--;
|
|
if (calibrator->current_test < 0)
|
|
finish_calibration(calibrator);
|
|
}
|
|
|
|
widget_schedule_redraw(widget);
|
|
}
|
|
|
|
static void
|
|
touch_handler(struct widget *widget, struct input *input, uint32_t serial,
|
|
uint32_t time, int32_t id, float x, float y, void *data)
|
|
{
|
|
struct calibrator *calibrator = data;
|
|
|
|
calibrator->tests[calibrator->current_test].clicked_x = x;
|
|
calibrator->tests[calibrator->current_test].clicked_y = y;
|
|
calibrator->current_test--;
|
|
|
|
if (calibrator->current_test < 0)
|
|
finish_calibration(calibrator);
|
|
|
|
widget_schedule_redraw(widget);
|
|
}
|
|
|
|
static void
|
|
redraw_handler(struct widget *widget, void *data)
|
|
{
|
|
struct calibrator *calibrator = data;
|
|
struct rectangle allocation;
|
|
cairo_surface_t *surface;
|
|
cairo_t *cr;
|
|
int32_t drawn_x, drawn_y;
|
|
|
|
widget_get_allocation(calibrator->widget, &allocation);
|
|
surface = window_get_surface(calibrator->window);
|
|
|
|
cr = cairo_create(surface);
|
|
cairo_set_operator(cr, CAIRO_OPERATOR_SOURCE);
|
|
cairo_set_source_rgba(cr, 1.0, 1.0, 1.0, 1.0);
|
|
cairo_paint(cr);
|
|
|
|
drawn_x = test_ratios[calibrator->current_test].x_ratio * allocation.width;
|
|
drawn_y = test_ratios[calibrator->current_test].y_ratio * allocation.height;
|
|
|
|
calibrator->tests[calibrator->current_test].drawn_x = drawn_x;
|
|
calibrator->tests[calibrator->current_test].drawn_y = drawn_y;
|
|
|
|
cairo_translate(cr, drawn_x, drawn_y);
|
|
cairo_set_line_width(cr, 2.0);
|
|
cairo_set_source_rgb(cr, 1.0, 0.0, 0.0);
|
|
cairo_move_to(cr, 0, -10.0);
|
|
cairo_line_to(cr, 0, 10.0);
|
|
cairo_stroke(cr);
|
|
cairo_move_to(cr, -10.0, 0);
|
|
cairo_line_to(cr, 10.0, 0.0);
|
|
cairo_stroke(cr);
|
|
|
|
cairo_destroy(cr);
|
|
cairo_surface_destroy(surface);
|
|
}
|
|
|
|
static struct calibrator *
|
|
calibrator_create(struct display *display)
|
|
{
|
|
struct calibrator *calibrator;
|
|
|
|
calibrator = malloc(sizeof *calibrator);
|
|
if (calibrator == NULL)
|
|
return NULL;
|
|
|
|
calibrator->window = window_create(display);
|
|
calibrator->widget = window_add_widget(calibrator->window, calibrator);
|
|
window_set_title(calibrator->window, "Wayland calibrator");
|
|
calibrator->display = display;
|
|
|
|
calibrator->current_test = ARRAY_LENGTH(test_ratios) - 1;
|
|
|
|
widget_set_button_handler(calibrator->widget, button_handler);
|
|
widget_set_touch_down_handler(calibrator->widget, touch_handler);
|
|
widget_set_redraw_handler(calibrator->widget, redraw_handler);
|
|
|
|
window_set_fullscreen(calibrator->window, 1);
|
|
|
|
return calibrator;
|
|
}
|
|
|
|
static void
|
|
calibrator_destroy(struct calibrator *calibrator)
|
|
{
|
|
widget_destroy(calibrator->widget);
|
|
window_destroy(calibrator->window);
|
|
free(calibrator);
|
|
}
|
|
|
|
|
|
int
|
|
main(int argc, char *argv[])
|
|
{
|
|
struct display *display;
|
|
struct calibrator *calibrator;
|
|
|
|
display = display_create(&argc, argv);
|
|
|
|
if (display == NULL) {
|
|
fprintf(stderr, "failed to create display: %m\n");
|
|
return -1;
|
|
}
|
|
|
|
calibrator = calibrator_create(display);
|
|
|
|
if (!calibrator)
|
|
return -1;
|
|
|
|
display_run(display);
|
|
|
|
calibrator_destroy(calibrator);
|
|
display_destroy(display);
|
|
|
|
return 0;
|
|
}
|
|
|