148905Srnordier/*
248905Srnordier * Copyright (c) 1999 Global Technology Associates, Inc.
348905Srnordier * All rights reserved.
448905Srnordier *
548905Srnordier * Redistribution and use in source and binary forms, with or without
648905Srnordier * modification, are permitted provided that the following conditions
748905Srnordier * are met:
848905Srnordier * 1. Redistributions of source code must retain the above copyright
948905Srnordier *    notice, this list of conditions and the following disclaimer.
1048905Srnordier * 2. Redistributions in binary form must reproduce the above copyright
1148905Srnordier *    notice, this list of conditions and the following disclaimer in the
1248905Srnordier *    documentation and/or other materials provided with the distribution.
1348905Srnordier *
1448905Srnordier * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS``AS IS'' AND
1548905Srnordier * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1648905Srnordier * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
1748905Srnordier * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS
1848905Srnordier * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
1948905Srnordier * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
2048905Srnordier * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
2148905Srnordier * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
2248905Srnordier * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
2348905Srnordier * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
2448905Srnordier * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
2548905Srnordier *
2650479Speter * $FreeBSD$
2748905Srnordier */
2848905Srnordier
29130927Sobrien#define	_KERNEL
30130927Sobrien#include <sys/param.h>
31130927Sobrien#undef _KERNEL
3248905Srnordier#include <sys/types.h>
3348905Srnordier#include <sys/stat.h>
3448905Srnordier#include <sys/wait.h>
3548905Srnordier
3648905Srnordier#include <err.h>
3748905Srnordier#include <fcntl.h>
3848905Srnordier#include <stdio.h>
3948905Srnordier#include <stdlib.h>
4048905Srnordier#include <unistd.h>
4148905Srnordier
42130927Sobrien#include <a.out.h>
4348905Srnordier
4468313Srnordier#include "aouthdr.h"
4548905Srnordier#include "elfhdr.h"
4648905Srnordier#include "kgzip.h"
4748905Srnordier
4848905Srnordierstatic void mk_data(const struct iodesc *i, const struct iodesc *,
4968313Srnordier		    struct kgz_hdr *, size_t);
5048905Srnordierstatic int ld_elf(const struct iodesc *, const struct iodesc *,
5148905Srnordier		  struct kgz_hdr *, const Elf32_Ehdr *);
5248905Srnordierstatic int ld_aout(const struct iodesc *, const struct iodesc *,
53130927Sobrien		   struct kgz_hdr *, const struct exec *);
5448905Srnordier
5548905Srnordier/*
5648905Srnordier * Compress executable and output it in relocatable object format.
5748905Srnordier */
5848905Srnordiervoid
5948905Srnordierkgzcmp(struct kgz_hdr *kh, const char *f1, const char *f2)
6048905Srnordier{
6148905Srnordier    struct iodesc idi, ido;
62112089Sru    struct kgz_hdr khle;
6348905Srnordier
6448905Srnordier    if ((idi.fd = open(idi.fname = f1, O_RDONLY)) == -1)
6548905Srnordier	err(1, "%s", idi.fname);
6648905Srnordier    if ((ido.fd = open(ido.fname = f2, O_CREAT | O_TRUNC | O_WRONLY,
6748905Srnordier		       0666)) == -1)
6848905Srnordier	err(1, "%s", ido.fname);
6948905Srnordier    kh->ident[0] = KGZ_ID0;
7048905Srnordier    kh->ident[1] = KGZ_ID1;
7148905Srnordier    kh->ident[2] = KGZ_ID2;
7248905Srnordier    kh->ident[3] = KGZ_ID3;
7368313Srnordier    mk_data(&idi, &ido, kh,
7468313Srnordier	    (format == F_AOUT ? sizeof(struct kgz_aouthdr0) :
7568313Srnordier				sizeof(struct kgz_elfhdr)) +
7668313Srnordier	     sizeof(struct kgz_hdr));
7748905Srnordier    kh->dload &= 0xffffff;
7848905Srnordier    kh->entry &= 0xffffff;
7968313Srnordier    if (format == F_AOUT) {
8068313Srnordier	struct kgz_aouthdr0 ahdr0 = aouthdr0;
8168313Srnordier	struct kgz_aouthdr1 ahdr1 = aouthdr1;
8268313Srnordier	unsigned x = (sizeof(struct kgz_hdr) + kh->nsize) & (16 - 1);
8368313Srnordier	if (x) {
8468313Srnordier	    x = 16 - x;
8568313Srnordier	    xzero(&ido, x);
8668313Srnordier	}
8768313Srnordier	xwrite(&ido, &ahdr1, sizeof(ahdr1));
8868313Srnordier	ahdr0.a.a_data += kh->nsize + x;
8968313Srnordier	xseek(&ido, 0);
9068313Srnordier	xwrite(&ido, &ahdr0, sizeof(ahdr0));
9168313Srnordier    } else {
9268313Srnordier	struct kgz_elfhdr ehdr = elfhdr;
93130927Sobrien	ehdr.st[KGZ_ST_KGZ_NDATA].st_size = htole32(kh->nsize);
94112089Sru	ehdr.sh[KGZ_SH_DATA].sh_size =
95130927Sobrien	    htole32(le32toh(ehdr.sh[KGZ_SH_DATA].sh_size) + kh->nsize);
9668313Srnordier	xseek(&ido, 0);
9768313Srnordier	xwrite(&ido, &ehdr, sizeof(ehdr));
9868313Srnordier    }
99112089Sru    khle = *kh;
100130927Sobrien    khle.dload = htole32(khle.dload);
101130927Sobrien    khle.dsize = htole32(khle.dsize);
102130927Sobrien    khle.isize = htole32(khle.isize);
103130927Sobrien    khle.entry = htole32(khle.entry);
104130927Sobrien    khle.nsize = htole32(khle.nsize);
105112089Sru    xwrite(&ido, &khle, sizeof(khle));
10648905Srnordier    xclose(&ido);
10748905Srnordier    xclose(&idi);
10848905Srnordier}
10948905Srnordier
11048905Srnordier/*
11148905Srnordier * Make encoded (compressed) data.
11248905Srnordier */
11348905Srnordierstatic void
11448905Srnordiermk_data(const struct iodesc * idi, const struct iodesc * ido,
11568313Srnordier	struct kgz_hdr * kh, size_t off)
11648905Srnordier{
11748905Srnordier    union {
118130927Sobrien	struct exec ex;
11948905Srnordier	Elf32_Ehdr ee;
12048905Srnordier    } hdr;
12148905Srnordier    struct stat sb;
12248905Srnordier    struct iodesc idp;
12348905Srnordier    int fd[2];
12448905Srnordier    pid_t pid;
12548905Srnordier    size_t n;
12648905Srnordier    int fmt, status, e;
12748905Srnordier
12848905Srnordier    n = xread(idi, &hdr, sizeof(hdr), 0);
12948905Srnordier    fmt = 0;
13048905Srnordier    if (n >= sizeof(hdr.ee) && IS_ELF(hdr.ee))
13148905Srnordier	fmt = F_ELF;
132130927Sobrien    else if (n >= sizeof(hdr.ex) && N_GETMAGIC(hdr.ex) == ZMAGIC)
13348905Srnordier	fmt = F_AOUT;
13448905Srnordier    if (!fmt)
13548905Srnordier	errx(1, "%s: Format not supported", idi->fname);
13668313Srnordier    xseek(ido, off);
13748905Srnordier    if (pipe(fd))
13848905Srnordier	err(1, NULL);
13948905Srnordier    switch (pid = fork()) {
14048905Srnordier    case -1:
14148905Srnordier	err(1, NULL);
14248905Srnordier    case 0:
14348905Srnordier	close(fd[1]);
14448905Srnordier	dup2(fd[0], STDIN_FILENO);
14548905Srnordier	close(fd[0]);
14648905Srnordier	close(idi->fd);
14748905Srnordier	dup2(ido->fd, STDOUT_FILENO);
14848905Srnordier	close(ido->fd);
149112047Sru	execlp("gzip", "gzip", "-9n", (char *)NULL);
15048905Srnordier	warn(NULL);
15148905Srnordier	_exit(1);
15248905Srnordier    default:
15348905Srnordier	close(fd[0]);
15448905Srnordier	idp.fname = "(pipe)";
15548905Srnordier	idp.fd = fd[1];
15648905Srnordier	e = fmt == F_ELF  ? ld_elf(idi, &idp, kh, &hdr.ee) :
15748905Srnordier	    fmt == F_AOUT ? ld_aout(idi, &idp, kh, &hdr.ex) : -1;
15848905Srnordier	close(fd[1]);
15948905Srnordier	if ((pid = waitpid(pid, &status, 0)) == -1)
16048905Srnordier	    err(1, NULL);
16148905Srnordier	if (WIFSIGNALED(status) || WEXITSTATUS(status))
16248905Srnordier	    exit(1);
16348905Srnordier    }
16448905Srnordier    if (e)
16548905Srnordier	errx(1, "%s: Invalid format", idi->fname);
16648905Srnordier    if (fstat(ido->fd, &sb))
16762986Skris	err(1, "%s", ido->fname);
16868313Srnordier    kh->nsize = sb.st_size - off;
16948905Srnordier}
17048905Srnordier
17148905Srnordier/*
17248905Srnordier * "Load" an ELF-format executable.
17348905Srnordier */
17448905Srnordierstatic int
17548905Srnordierld_elf(const struct iodesc * idi, const struct iodesc * ido,
17648905Srnordier       struct kgz_hdr * kh, const Elf32_Ehdr * e)
17748905Srnordier{
17848905Srnordier    Elf32_Phdr p;
17948905Srnordier    size_t load, addr, n;
18048905Srnordier    unsigned x, i;
18148905Srnordier
18248905Srnordier    load = addr = n = 0;
18348905Srnordier    for (x = i = 0; i < e->e_phnum; i++) {
18448905Srnordier	if (xread(idi, &p, sizeof(p),
18548905Srnordier		  e->e_phoff + i * e->e_phentsize) != e->e_phentsize)
18648905Srnordier	    return -1;
18748905Srnordier	if (p.p_type != PT_LOAD)
18848905Srnordier	    continue;
18948905Srnordier	if (!x)
19048905Srnordier	    load = addr = p.p_vaddr;
19148905Srnordier	else {
19248905Srnordier	    if (p.p_vaddr < addr)
19348905Srnordier		return -1;
19448905Srnordier	    n = p.p_vaddr - addr;
19548905Srnordier	    if (n) {
19648905Srnordier		xzero(ido, n);
19748905Srnordier		addr += n;
19848905Srnordier	    }
19948905Srnordier	}
20048905Srnordier	if (p.p_memsz < p.p_filesz)
20148905Srnordier	    return -1;
20248905Srnordier	n = p.p_memsz - p.p_filesz;
20348905Srnordier	xcopy(idi, ido, p.p_filesz, p.p_offset);
20448905Srnordier	addr += p.p_filesz;
20548905Srnordier	x++;
20648905Srnordier    }
20748905Srnordier    if (!x)
20848905Srnordier	return -1;
20948905Srnordier    kh->dload = load;
21048905Srnordier    kh->dsize = addr - load;
21148905Srnordier    kh->isize = kh->dsize + n;
21248905Srnordier    kh->entry = e->e_entry;
21348905Srnordier    return 0;
21448905Srnordier}
21548905Srnordier
21648905Srnordier/*
21748905Srnordier * "Load" an a.out-format executable.
21848905Srnordier */
21948905Srnordierstatic int
22048905Srnordierld_aout(const struct iodesc * idi, const struct iodesc * ido,
221130927Sobrien	struct kgz_hdr * kh, const struct exec * a)
22248905Srnordier{
22348905Srnordier    size_t load, addr;
22448905Srnordier
225130927Sobrien    load = addr = N_TXTADDR(*a);
226130927Sobrien    xcopy(idi, ido, le32toh(a->a_text), N_TXTOFF(*a));
227130927Sobrien    addr += le32toh(a->a_text);
228130927Sobrien    if (N_DATADDR(*a) != addr)
22948905Srnordier	return -1;
230130927Sobrien    xcopy(idi, ido, le32toh(a->a_data), N_DATOFF(*a));
231130927Sobrien    addr += le32toh(a->a_data);
23248905Srnordier    kh->dload = load;
23348905Srnordier    kh->dsize = addr - load;
234130927Sobrien    kh->isize = kh->dsize + le32toh(a->a_bss);
235130927Sobrien    kh->entry = le32toh(a->a_entry);
23648905Srnordier    return 0;
23748905Srnordier}
238