1ce3adf43SDag-Erling Smørgrav /*
2ce3adf43SDag-Erling Smørgrav * Copyright (c) 2012 Damien Miller <djm@mindrot.org>
3ce3adf43SDag-Erling Smørgrav *
4ce3adf43SDag-Erling Smørgrav * Permission to use, copy, modify, and distribute this software for any
5ce3adf43SDag-Erling Smørgrav * purpose with or without fee is hereby granted, provided that the above
6ce3adf43SDag-Erling Smørgrav * copyright notice and this permission notice appear in all copies.
7ce3adf43SDag-Erling Smørgrav *
8ce3adf43SDag-Erling Smørgrav * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9ce3adf43SDag-Erling Smørgrav * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10ce3adf43SDag-Erling Smørgrav * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11ce3adf43SDag-Erling Smørgrav * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12ce3adf43SDag-Erling Smørgrav * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13ce3adf43SDag-Erling Smørgrav * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14ce3adf43SDag-Erling Smørgrav * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15ce3adf43SDag-Erling Smørgrav */
16ce3adf43SDag-Erling Smørgrav
17f7167e0eSDag-Erling Smørgrav /* $OpenBSD: modpipe.c,v 1.6 2013/11/21 03:16:47 djm Exp $ */
18ce3adf43SDag-Erling Smørgrav
19ce3adf43SDag-Erling Smørgrav #include "includes.h"
20ce3adf43SDag-Erling Smørgrav
21ce3adf43SDag-Erling Smørgrav #include <sys/types.h>
22ce3adf43SDag-Erling Smørgrav #include <unistd.h>
23ce3adf43SDag-Erling Smørgrav #include <stdio.h>
24ce3adf43SDag-Erling Smørgrav #include <string.h>
25ce3adf43SDag-Erling Smørgrav #include <stdarg.h>
26ce3adf43SDag-Erling Smørgrav #include <stdlib.h>
27ce3adf43SDag-Erling Smørgrav #include <errno.h>
28*076ad2f8SDag-Erling Smørgrav #ifdef HAVE_ERR_H
29*076ad2f8SDag-Erling Smørgrav # include <err.h>
30*076ad2f8SDag-Erling Smørgrav #endif
31ce3adf43SDag-Erling Smørgrav #include "openbsd-compat/getopt_long.c"
32ce3adf43SDag-Erling Smørgrav
33ce3adf43SDag-Erling Smørgrav static void
usage(void)34ce3adf43SDag-Erling Smørgrav usage(void)
35ce3adf43SDag-Erling Smørgrav {
36ce3adf43SDag-Erling Smørgrav fprintf(stderr, "Usage: modpipe -w [-m modspec ...] < in > out\n");
37ce3adf43SDag-Erling Smørgrav fprintf(stderr, "modspec is one of:\n");
38ce3adf43SDag-Erling Smørgrav fprintf(stderr, " xor:offset:value - XOR \"value\" at \"offset\"\n");
39ce3adf43SDag-Erling Smørgrav fprintf(stderr, " andor:offset:val1:val2 - AND \"val1\" then OR \"val2\" at \"offset\"\n");
40ce3adf43SDag-Erling Smørgrav exit(1);
41ce3adf43SDag-Erling Smørgrav }
42ce3adf43SDag-Erling Smørgrav
43ce3adf43SDag-Erling Smørgrav #define MAX_MODIFICATIONS 256
44ce3adf43SDag-Erling Smørgrav struct modification {
45ce3adf43SDag-Erling Smørgrav enum { MOD_XOR, MOD_AND_OR } what;
46f7167e0eSDag-Erling Smørgrav unsigned long long offset;
47ce3adf43SDag-Erling Smørgrav u_int8_t m1, m2;
48ce3adf43SDag-Erling Smørgrav };
49ce3adf43SDag-Erling Smørgrav
50ce3adf43SDag-Erling Smørgrav static void
parse_modification(const char * s,struct modification * m)51ce3adf43SDag-Erling Smørgrav parse_modification(const char *s, struct modification *m)
52ce3adf43SDag-Erling Smørgrav {
53ce3adf43SDag-Erling Smørgrav char what[16+1];
54ce3adf43SDag-Erling Smørgrav int n, m1, m2;
55ce3adf43SDag-Erling Smørgrav
56ce3adf43SDag-Erling Smørgrav bzero(m, sizeof(*m));
57f7167e0eSDag-Erling Smørgrav if ((n = sscanf(s, "%16[^:]%*[:]%llu%*[:]%i%*[:]%i",
58ce3adf43SDag-Erling Smørgrav what, &m->offset, &m1, &m2)) < 3)
59ce3adf43SDag-Erling Smørgrav errx(1, "Invalid modification spec \"%s\"", s);
60ce3adf43SDag-Erling Smørgrav if (strcasecmp(what, "xor") == 0) {
61ce3adf43SDag-Erling Smørgrav if (n > 3)
62ce3adf43SDag-Erling Smørgrav errx(1, "Invalid modification spec \"%s\"", s);
63ce3adf43SDag-Erling Smørgrav if (m1 < 0 || m1 > 0xff)
64ce3adf43SDag-Erling Smørgrav errx(1, "Invalid XOR modification value");
65ce3adf43SDag-Erling Smørgrav m->what = MOD_XOR;
66ce3adf43SDag-Erling Smørgrav m->m1 = m1;
67ce3adf43SDag-Erling Smørgrav } else if (strcasecmp(what, "andor") == 0) {
68ce3adf43SDag-Erling Smørgrav if (n != 4)
69ce3adf43SDag-Erling Smørgrav errx(1, "Invalid modification spec \"%s\"", s);
70ce3adf43SDag-Erling Smørgrav if (m1 < 0 || m1 > 0xff)
71ce3adf43SDag-Erling Smørgrav errx(1, "Invalid AND modification value");
72ce3adf43SDag-Erling Smørgrav if (m2 < 0 || m2 > 0xff)
73ce3adf43SDag-Erling Smørgrav errx(1, "Invalid OR modification value");
74ce3adf43SDag-Erling Smørgrav m->what = MOD_AND_OR;
75ce3adf43SDag-Erling Smørgrav m->m1 = m1;
76ce3adf43SDag-Erling Smørgrav m->m2 = m2;
77ce3adf43SDag-Erling Smørgrav } else
78ce3adf43SDag-Erling Smørgrav errx(1, "Invalid modification type \"%s\"", what);
79ce3adf43SDag-Erling Smørgrav }
80ce3adf43SDag-Erling Smørgrav
81ce3adf43SDag-Erling Smørgrav int
main(int argc,char ** argv)82ce3adf43SDag-Erling Smørgrav main(int argc, char **argv)
83ce3adf43SDag-Erling Smørgrav {
84ce3adf43SDag-Erling Smørgrav int ch;
85ce3adf43SDag-Erling Smørgrav u_char buf[8192];
86ce3adf43SDag-Erling Smørgrav size_t total;
87ce3adf43SDag-Erling Smørgrav ssize_t r, s, o;
88ce3adf43SDag-Erling Smørgrav struct modification mods[MAX_MODIFICATIONS];
89ce3adf43SDag-Erling Smørgrav u_int i, wflag = 0, num_mods = 0;
90ce3adf43SDag-Erling Smørgrav
91ce3adf43SDag-Erling Smørgrav while ((ch = getopt(argc, argv, "wm:")) != -1) {
92ce3adf43SDag-Erling Smørgrav switch (ch) {
93ce3adf43SDag-Erling Smørgrav case 'm':
94ce3adf43SDag-Erling Smørgrav if (num_mods >= MAX_MODIFICATIONS)
95ce3adf43SDag-Erling Smørgrav errx(1, "Too many modifications");
96ce3adf43SDag-Erling Smørgrav parse_modification(optarg, &(mods[num_mods++]));
97ce3adf43SDag-Erling Smørgrav break;
98ce3adf43SDag-Erling Smørgrav case 'w':
99ce3adf43SDag-Erling Smørgrav wflag = 1;
100ce3adf43SDag-Erling Smørgrav break;
101ce3adf43SDag-Erling Smørgrav default:
102ce3adf43SDag-Erling Smørgrav usage();
103ce3adf43SDag-Erling Smørgrav /* NOTREACHED */
104ce3adf43SDag-Erling Smørgrav }
105ce3adf43SDag-Erling Smørgrav }
106ce3adf43SDag-Erling Smørgrav for (total = 0;;) {
107ce3adf43SDag-Erling Smørgrav r = s = read(STDIN_FILENO, buf, sizeof(buf));
108ce3adf43SDag-Erling Smørgrav if (r == 0)
109ce3adf43SDag-Erling Smørgrav break;
110ce3adf43SDag-Erling Smørgrav if (r < 0) {
111ce3adf43SDag-Erling Smørgrav if (errno == EAGAIN || errno == EINTR)
112ce3adf43SDag-Erling Smørgrav continue;
113ce3adf43SDag-Erling Smørgrav err(1, "read");
114ce3adf43SDag-Erling Smørgrav }
115ce3adf43SDag-Erling Smørgrav for (i = 0; i < num_mods; i++) {
116ce3adf43SDag-Erling Smørgrav if (mods[i].offset < total ||
117ce3adf43SDag-Erling Smørgrav mods[i].offset >= total + s)
118ce3adf43SDag-Erling Smørgrav continue;
119ce3adf43SDag-Erling Smørgrav switch (mods[i].what) {
120ce3adf43SDag-Erling Smørgrav case MOD_XOR:
121ce3adf43SDag-Erling Smørgrav buf[mods[i].offset - total] ^= mods[i].m1;
122ce3adf43SDag-Erling Smørgrav break;
123ce3adf43SDag-Erling Smørgrav case MOD_AND_OR:
124ce3adf43SDag-Erling Smørgrav buf[mods[i].offset - total] &= mods[i].m1;
125ce3adf43SDag-Erling Smørgrav buf[mods[i].offset - total] |= mods[i].m2;
126ce3adf43SDag-Erling Smørgrav break;
127ce3adf43SDag-Erling Smørgrav }
128ce3adf43SDag-Erling Smørgrav }
129ce3adf43SDag-Erling Smørgrav for (o = 0; o < s; o += r) {
130ce3adf43SDag-Erling Smørgrav r = write(STDOUT_FILENO, buf, s - o);
131ce3adf43SDag-Erling Smørgrav if (r == 0)
132ce3adf43SDag-Erling Smørgrav break;
133ce3adf43SDag-Erling Smørgrav if (r < 0) {
134ce3adf43SDag-Erling Smørgrav if (errno == EAGAIN || errno == EINTR)
135ce3adf43SDag-Erling Smørgrav continue;
136ce3adf43SDag-Erling Smørgrav err(1, "write");
137ce3adf43SDag-Erling Smørgrav }
138ce3adf43SDag-Erling Smørgrav }
139ce3adf43SDag-Erling Smørgrav total += s;
140ce3adf43SDag-Erling Smørgrav }
141ce3adf43SDag-Erling Smørgrav /* Warn if modifications not reached in input stream */
142ce3adf43SDag-Erling Smørgrav r = 0;
143ce3adf43SDag-Erling Smørgrav for (i = 0; wflag && i < num_mods; i++) {
144ce3adf43SDag-Erling Smørgrav if (mods[i].offset < total)
145ce3adf43SDag-Erling Smørgrav continue;
146ce3adf43SDag-Erling Smørgrav r = 1;
147ce3adf43SDag-Erling Smørgrav fprintf(stderr, "modpipe: warning - mod %u not reached\n", i);
148ce3adf43SDag-Erling Smørgrav }
149ce3adf43SDag-Erling Smørgrav return r;
150ce3adf43SDag-Erling Smørgrav }
151