Magisk/jni/magiskboot/boot_utils.c

103 lines
2.4 KiB
C
Raw Normal View History

2017-09-14 17:11:56 +02:00
#include <unistd.h>
#include <stdio.h>
#include <sys/mman.h>
2017-03-04 14:16:59 +01:00
2017-09-14 17:11:56 +02:00
#include "utils.h"
2017-09-12 09:27:28 +02:00
void mmap_ro(const char *filename, void **buf, size_t *size) {
2017-04-28 15:48:38 +02:00
int fd = xopen(filename, O_RDONLY);
2017-03-04 14:16:59 +01:00
*size = lseek(fd, 0, SEEK_END);
lseek(fd, 0, SEEK_SET);
2017-10-07 16:08:10 +02:00
*buf = *size > 0 ? xmmap(NULL, *size, PROT_READ, MAP_SHARED, fd, 0) : NULL;
2017-03-04 14:16:59 +01:00
close(fd);
}
2017-09-12 09:27:28 +02:00
void mmap_rw(const char *filename, void **buf, size_t *size) {
2017-04-28 15:48:38 +02:00
int fd = xopen(filename, O_RDWR);
2017-03-04 14:16:59 +01:00
*size = lseek(fd, 0, SEEK_END);
lseek(fd, 0, SEEK_SET);
2017-10-07 16:08:10 +02:00
*buf = *size > 0 ? xmmap(NULL, *size, PROT_READ | PROT_WRITE, MAP_SHARED, fd, 0) : NULL;
2017-03-04 14:16:59 +01:00
close(fd);
}
void write_zero(int fd, size_t size) {
size_t pos = lseek(fd, 0, SEEK_CUR);
ftruncate(fd, pos + size);
lseek(fd, pos + size, SEEK_SET);
}
2017-03-04 14:16:59 +01:00
void mem_align(size_t *pos, size_t align) {
size_t mask = align - 1;
if (*pos & mask) {
*pos += align - (*pos & mask);
}
}
2017-03-07 17:54:23 +01:00
void file_align(int fd, size_t align, int out) {
2017-03-04 14:16:59 +01:00
size_t pos = lseek(fd, 0, SEEK_CUR);
size_t mask = align - 1;
2017-03-12 21:19:30 +01:00
size_t off;
2017-03-04 14:16:59 +01:00
if (pos & mask) {
2017-03-12 21:19:30 +01:00
off = align - (pos & mask);
2017-03-07 17:54:23 +01:00
if (out) {
write_zero(fd, off);
2017-03-12 21:19:30 +01:00
} else {
lseek(fd, pos + off, SEEK_SET);
2017-03-07 17:54:23 +01:00
}
2017-03-04 14:16:59 +01:00
}
}
int open_new(const char *filename) {
2017-04-28 15:48:38 +02:00
return xopen(filename, O_WRONLY | O_CREAT | O_TRUNC, 0644);
2017-03-04 14:16:59 +01:00
}
2017-09-14 19:45:39 +02:00
void *patch_init_rc(char *data, uint32_t *size) {
int injected = 0;
char *new_data = xmalloc(*size + 23);
char *old_data = data;
uint32_t pos = 0;
for (char *tok = strsep(&old_data, "\n"); tok; tok = strsep(&old_data, "\n")) {
if (!injected && strncmp(tok, "import", 6) == 0) {
if (strstr(tok, "init.magisk.rc")) {
injected = 1;
} else {
fprintf(stderr, "Inject [import /init.magisk.rc] to [init.rc]\n");
strcpy(new_data + pos, "import /init.magisk.rc\n");
pos += 23;
injected = 1;
}
} else if (strstr(tok, "selinux.reload_policy")) {
continue;
}
// Copy the line
strcpy(new_data + pos, tok);
pos += strlen(tok);
new_data[pos++] = '\n';
}
*size = pos;
return new_data;
}
int check_verity_pattern(const char *s) {
int pos = 0;
if (s[0] == ',') ++pos;
if (strncmp(s + pos, "verify", 6) != 0) return -1;
pos += 6;
if (s[pos] == '=') {
2017-09-14 20:52:27 +02:00
while (s[pos] != '\0' && s[pos] != ' ' && s[pos] != '\n' && s[pos] != ',') ++pos;
2017-09-14 19:45:39 +02:00
}
return pos;
}
int check_encryption_pattern(const char *s) {
2017-09-25 20:04:07 +02:00
const char *encrypt_list[] = { "forceencrypt", "forcefdeorfbe", NULL };
2017-09-14 19:45:39 +02:00
for (int i = 0 ; encrypt_list[i]; ++i) {
int len = strlen(encrypt_list[i]);
if (strncmp(s, encrypt_list[i], len) == 0)
return len;
}
return -1;
}