1065f4483Smarkus /*
2065f4483Smarkus * Copyright (c) 2012 Damien Miller <djm@mindrot.org>
3065f4483Smarkus *
4065f4483Smarkus * Permission to use, copy, modify, and distribute this software for any
5065f4483Smarkus * purpose with or without fee is hereby granted, provided that the above
6065f4483Smarkus * copyright notice and this permission notice appear in all copies.
7065f4483Smarkus *
8065f4483Smarkus * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9065f4483Smarkus * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10065f4483Smarkus * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11065f4483Smarkus * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12065f4483Smarkus * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13065f4483Smarkus * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14065f4483Smarkus * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15065f4483Smarkus */
16065f4483Smarkus
17*e8c2e923Sdjm /* $OpenBSD: modpipe.c,v 1.6 2013/11/21 03:16:47 djm Exp $ */
18a47af7fbSdjm
19065f4483Smarkus #include <sys/types.h>
20065f4483Smarkus #include <unistd.h>
21065f4483Smarkus #include <stdio.h>
22065f4483Smarkus #include <string.h>
23065f4483Smarkus #include <stdlib.h>
24065f4483Smarkus #include <err.h>
25065f4483Smarkus #include <errno.h>
26065f4483Smarkus
27065f4483Smarkus static void
usage(void)28065f4483Smarkus usage(void)
29065f4483Smarkus {
301567085cSdjm fprintf(stderr, "Usage: modpipe -w [-m modspec ...] < in > out\n");
31065f4483Smarkus fprintf(stderr, "modspec is one of:\n");
32065f4483Smarkus fprintf(stderr, " xor:offset:value - XOR \"value\" at \"offset\"\n");
33065f4483Smarkus fprintf(stderr, " andor:offset:val1:val2 - AND \"val1\" then OR \"val2\" at \"offset\"\n");
34065f4483Smarkus exit(1);
35065f4483Smarkus }
36065f4483Smarkus
37065f4483Smarkus #define MAX_MODIFICATIONS 256
38065f4483Smarkus struct modification {
39065f4483Smarkus enum { MOD_XOR, MOD_AND_OR } what;
40*e8c2e923Sdjm unsigned long long offset;
41065f4483Smarkus u_int8_t m1, m2;
42065f4483Smarkus };
43065f4483Smarkus
44065f4483Smarkus static void
parse_modification(const char * s,struct modification * m)45065f4483Smarkus parse_modification(const char *s, struct modification *m)
46065f4483Smarkus {
47065f4483Smarkus char what[16+1];
48310e9bf1Sdjm int n, m1, m2;
49065f4483Smarkus
50065f4483Smarkus bzero(m, sizeof(*m));
51*e8c2e923Sdjm if ((n = sscanf(s, "%16[^:]%*[:]%llu%*[:]%i%*[:]%i",
52310e9bf1Sdjm what, &m->offset, &m1, &m2)) < 3)
53065f4483Smarkus errx(1, "Invalid modification spec \"%s\"", s);
54065f4483Smarkus if (strcasecmp(what, "xor") == 0) {
55065f4483Smarkus if (n > 3)
56065f4483Smarkus errx(1, "Invalid modification spec \"%s\"", s);
57310e9bf1Sdjm if (m1 < 0 || m1 > 0xff)
58310e9bf1Sdjm errx(1, "Invalid XOR modification value");
59310e9bf1Sdjm m->what = MOD_XOR;
60310e9bf1Sdjm m->m1 = m1;
61065f4483Smarkus } else if (strcasecmp(what, "andor") == 0) {
62065f4483Smarkus if (n != 4)
63065f4483Smarkus errx(1, "Invalid modification spec \"%s\"", s);
64310e9bf1Sdjm if (m1 < 0 || m1 > 0xff)
65310e9bf1Sdjm errx(1, "Invalid AND modification value");
66310e9bf1Sdjm if (m2 < 0 || m2 > 0xff)
67310e9bf1Sdjm errx(1, "Invalid OR modification value");
68310e9bf1Sdjm m->what = MOD_AND_OR;
69310e9bf1Sdjm m->m1 = m1;
70310e9bf1Sdjm m->m2 = m2;
71065f4483Smarkus } else
72065f4483Smarkus errx(1, "Invalid modification type \"%s\"", what);
73065f4483Smarkus }
74065f4483Smarkus
75065f4483Smarkus int
main(int argc,char ** argv)76065f4483Smarkus main(int argc, char **argv)
77065f4483Smarkus {
78065f4483Smarkus int ch;
79065f4483Smarkus u_char buf[8192];
80065f4483Smarkus size_t total;
81065f4483Smarkus ssize_t r, s, o;
82065f4483Smarkus struct modification mods[MAX_MODIFICATIONS];
831567085cSdjm u_int i, wflag = 0, num_mods = 0;
84065f4483Smarkus
851567085cSdjm while ((ch = getopt(argc, argv, "wm:")) != -1) {
86065f4483Smarkus switch (ch) {
87065f4483Smarkus case 'm':
88065f4483Smarkus if (num_mods >= MAX_MODIFICATIONS)
89065f4483Smarkus errx(1, "Too many modifications");
90065f4483Smarkus parse_modification(optarg, &(mods[num_mods++]));
91065f4483Smarkus break;
921567085cSdjm case 'w':
931567085cSdjm wflag = 1;
941567085cSdjm break;
95065f4483Smarkus default:
96065f4483Smarkus usage();
97065f4483Smarkus /* NOTREACHED */
98065f4483Smarkus }
99065f4483Smarkus }
100065f4483Smarkus for (total = 0;;) {
101065f4483Smarkus r = s = read(STDIN_FILENO, buf, sizeof(buf));
102065f4483Smarkus if (r == 0)
1031567085cSdjm break;
104065f4483Smarkus if (r < 0) {
105065f4483Smarkus if (errno == EAGAIN || errno == EINTR)
106065f4483Smarkus continue;
107065f4483Smarkus err(1, "read");
108065f4483Smarkus }
109065f4483Smarkus for (i = 0; i < num_mods; i++) {
110065f4483Smarkus if (mods[i].offset < total ||
111065f4483Smarkus mods[i].offset >= total + s)
112065f4483Smarkus continue;
113065f4483Smarkus switch (mods[i].what) {
114065f4483Smarkus case MOD_XOR:
115065f4483Smarkus buf[mods[i].offset - total] ^= mods[i].m1;
116065f4483Smarkus break;
117065f4483Smarkus case MOD_AND_OR:
118065f4483Smarkus buf[mods[i].offset - total] &= mods[i].m1;
119065f4483Smarkus buf[mods[i].offset - total] |= mods[i].m2;
120065f4483Smarkus break;
121065f4483Smarkus }
122065f4483Smarkus }
123065f4483Smarkus for (o = 0; o < s; o += r) {
124065f4483Smarkus r = write(STDOUT_FILENO, buf, s - o);
125065f4483Smarkus if (r == 0)
1261567085cSdjm break;
127065f4483Smarkus if (r < 0) {
128065f4483Smarkus if (errno == EAGAIN || errno == EINTR)
129065f4483Smarkus continue;
130065f4483Smarkus err(1, "write");
131065f4483Smarkus }
132065f4483Smarkus }
133065f4483Smarkus total += s;
134065f4483Smarkus }
1351567085cSdjm /* Warn if modifications not reached in input stream */
1361567085cSdjm r = 0;
1371567085cSdjm for (i = 0; wflag && i < num_mods; i++) {
1381567085cSdjm if (mods[i].offset < total)
1391567085cSdjm continue;
1401567085cSdjm r = 1;
1411567085cSdjm fprintf(stderr, "modpipe: warning - mod %u not reached\n", i);
1421567085cSdjm }
1431567085cSdjm return r;
144065f4483Smarkus }
145