1 files changed, 127 insertions, 0 deletions
diff --git a/lib/sqfs/write_dir.c b/lib/sqfs/write_dir.c
new file mode 100644
index 0000000..b334864
--- /dev/null
+++ b/lib/sqfs/write_dir.c
@@ -0,0 +1,127 @@
+/* SPDX-License-Identifier: GPL-3.0-or-later */
+#include "meta_writer.h"
+#include "util.h"
+
+#include <assert.h>
+#include <endian.h>
+#include <stdlib.h>
+#include <string.h>
+#include <stdio.h>
+
+static int get_type(mode_t mode)
+{
+	switch (mode & S_IFMT) {
+	case S_IFSOCK: return SQFS_INODE_SOCKET;
+	case S_IFIFO:  return SQFS_INODE_FIFO;
+	case S_IFLNK:  return SQFS_INODE_SLINK;
+	case S_IFBLK:  return SQFS_INODE_BDEV;
+	case S_IFCHR:  return SQFS_INODE_CDEV;
+	case S_IFDIR:  return SQFS_INODE_DIR;
+	case S_IFREG:  return SQFS_INODE_FILE;
+	default:
+		assert(0);
+	}
+}
+
+static int dir_index_grow(dir_index_t **index)
+{
+	size_t size = sizeof(dir_index_t) + sizeof(idx_ref_t) * 10;
+	void *new;
+
+	if (*index == NULL) {
+		new = calloc(1, size);
+	} else {
+		if ((*index)->num_nodes < (*index)->max_nodes)
+			return 0;
+
+		size += sizeof(idx_ref_t) * (*index)->num_nodes;
+		new = realloc(*index, size);
+	}
+
+	if (new == NULL) {
+		perror("creating directory index");
+		return -1;
+	}
+
+	*index = new;
+	(*index)->max_nodes += 10;
+	return 0;
+}
+
+int meta_writer_write_dir(meta_writer_t *dm, dir_info_t *dir,
+			  dir_index_t **index)
+{
+	size_t i, size, count;
+	sqfs_dir_header_t hdr;
+	sqfs_dir_entry_t ent;
+	tree_node_t *c, *d;
+	uint32_t offset;
+	uint64_t block;
+
+	c = dir->children;
+	dir->size = 0;
+
+	meta_writer_get_position(dm, &dir->start_block, &dir->block_offset);
+
+	while (c != NULL) {
+		meta_writer_get_position(dm, &block, &offset);
+
+		count = 0;
+		size = (offset + sizeof(hdr)) % SQFS_META_BLOCK_SIZE;
+
+		for (d = c; d != NULL; d = d->next) {
+			if ((d->inode_ref >> 16) != (c->inode_ref >> 16))
+				break;
+
+			/* XXX: difference is actually signed */
+			if ((d->inode_num - c->inode_num) > 0x7FFF)
+				break;
+
+			size += sizeof(ent) + strlen(c->name);
+
+			if (count > 0 && size > SQFS_META_BLOCK_SIZE)
+				break;
+
+			count += 1;
+		}
+
+		if (count > SQFS_MAX_DIR_ENT)
+			count = SQFS_MAX_DIR_ENT;
+
+		if (dir_index_grow(index))
+			return -1;
+
+		meta_writer_get_position(dm, &block, &offset);
+
+		i = (*index)->num_nodes++;
+		(*index)->idx_nodes[i].node = c;
+		(*index)->idx_nodes[i].block = block;
+		(*index)->idx_nodes[i].offset = offset;
+
+		hdr.count = htole32(count - 1);
+		hdr.start_block = htole32(c->inode_ref >> 16);
+		hdr.inode_number = htole32(c->inode_num);
+		dir->size += sizeof(hdr);
+
+		if (meta_writer_append(dm, &hdr, sizeof(hdr)))
+			return -1;
+
+		d = c;
+
+		for (i = 0; i < count; ++i) {
+			ent.offset = htole16(c->inode_ref & 0x0000FFFF);
+			ent.inode_number = htole16(c->inode_num - d->inode_num);
+			ent.type = htole16(get_type(c->mode));
+			ent.size = htole16(strlen(c->name) - 1);
+			dir->size += sizeof(ent) + strlen(c->name);
+
+			if (meta_writer_append(dm, &ent, sizeof(ent)))
+				return -1;
+			if (meta_writer_append(dm, c->name, strlen(c->name)))
+				return -1;
+
+			c = c->next;
+		}
+	}
+	return 0;
+}