aboutsummaryrefslogtreecommitdiffstats
path: root/src/vu-set-saturation.c
blob: 33630f29ee1c1b47ac513ac3719593439711c06f (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
/* See LICENSE file for copyright and license details. */
#include "stream.h"
#include "util.h"

#include <fcntl.h>
#include <stdint.h>
#include <string.h>
#include <unistd.h>

USAGE("[-w] saturation-stream")

static void
process_xyza(struct stream *colour, struct stream *satur, size_t n)
{
	size_t i;
	double s, *x, *z, X, Z;
	X = D65_XYY_X / D65_XYY_Y;
	Z = 1 / D65_XYY_Y - 1 - X;
	for (i = 0; i < n; i += colour->pixel_size) {
		s = ((double *)(satur->buf + i))[1];
		s *= ((double *)(satur->buf + i))[3];
		x = ((double *)(colour->buf + i)) + 0;
		z = ((double *)(colour->buf + i)) + 2;
		*x = (*x - X) * s + X;
		*z = (*z - Z) * s + Z;
	}
}

static void
process_xyza_w(struct stream *colour, struct stream *satur, size_t n)
{
	size_t i;
	double s, *x, *z, X, Z;
	for (i = 0; i < n; i += colour->pixel_size) {
		X = ((double *)(satur->buf + i))[0];
		Z = ((double *)(satur->buf + i))[2];
		s = ((double *)(satur->buf + i))[1];
		s *= ((double *)(satur->buf + i))[3];
		x = ((double *)(colour->buf + i)) + 0;
		z = ((double *)(colour->buf + i)) + 2;
		*x = (*x - X) * s + X;
		*z = (*z - Z) * s + Z;
	}
}

int
main(int argc, char *argv[])
{
	struct stream colour, satur;
	int whitepoint = 0;
	size_t n;
	void (*process)(struct stream *colour, struct stream *satur, size_t n) = NULL;

	ARGBEGIN {
	case 'w':
		whitepoint = 1;
		break;
	default:
		usage();
	} ARGEND;

	if (argc != 1)
		usage();

	colour.file = "<stdin>";
	colour.fd = STDIN_FILENO;
	einit_stream(&colour);

	satur.file = argv[0];
	satur.fd = eopen(satur.file, O_RDONLY);
	einit_stream(&satur);

	echeck_compat(&colour, &satur);

	if (!strcmp(colour.pixfmt, "xyza"))
		process = whitepoint ? process_xyza_w : process_xyza;
	else
		eprintf("pixel format %s is not supported, try xyza\n", colour.pixfmt);

	for (;;) {
		if (colour.ptr < sizeof(colour.buf) && !eread_stream(&colour, SIZE_MAX)) {
			close(colour.fd);
			colour.fd = -1;
			break;
		}
		if (satur.ptr < sizeof(satur.buf) && !eread_stream(&satur, SIZE_MAX)) {
			close(satur.fd);
			satur.fd = -1;
			break;
		}

		n = colour.ptr < satur.ptr ? colour.ptr : satur.ptr;
		n -= n % colour.pixel_size;
		colour.ptr -= n;
		satur.ptr -= n;

		process(&colour, &satur, n);

		ewriteall(STDOUT_FILENO, colour.buf, n, "<stdout>");
		if ((n & 3) || colour.ptr != satur.ptr) {
			memmove(colour.buf, colour.buf + n, colour.ptr);
			memmove(satur.buf,  satur.buf  + n, satur.ptr);
		}
	}

	if (satur.fd >= 0)
		close(satur.fd);

	ewriteall(STDOUT_FILENO, colour.buf, colour.ptr, "<stdout>");

	if (colour.fd >= 0) {
		for (;;) {
			colour.ptr = 0;
			if (!eread_stream(&colour, SIZE_MAX)) {
				close(colour.fd);
				colour.fd = -1;
				break;
			}
			ewriteall(STDOUT_FILENO, colour.buf, colour.ptr, "<stdout>");
		}
	}

	return 0;
}