pinephone-keyboard/bin2pgd.c

92 lines
1.7 KiB
C
Raw Normal View History

#include <assert.h>
#include <errno.h>
#include <fcntl.h>
#include <inttypes.h>
#include <stdarg.h>
#include <stdbool.h>
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/stat.h>
#include <time.h>
#include <poll.h>
#include <sys/ioctl.h>
#include <unistd.h>
#include <sys/types.h>
#include <dirent.h>
#include <getopt.h>
static void syscall_error(int is_err, const char* fmt, ...)
{
va_list ap;
if (!is_err)
return;
fprintf(stderr, "ERROR: ");
va_start(ap, fmt);
vfprintf(stderr, fmt, ap);
va_end(ap);
fprintf(stderr, ": %s\n", strerror(errno));
exit(1);
}
static void error(const char* fmt, ...)
{
va_list ap;
fprintf(stderr, "ERROR: ");
va_start(ap, fmt);
vfprintf(stderr, fmt, ap);
va_end(ap);
fprintf(stderr, "\n");
exit(1);
}
int main(int ac, char* av[])
{
int fd, ret;
uint8_t rom[0x8100];
memset(rom, 0xff, sizeof rom);
fd = open(av[1], O_RDONLY);
syscall_error(fd < 0, "open(%s) failed", av[1]);
ssize_t len = read(fd, rom, 0x8000);
syscall_error(len < 0, "read failed");
close(fd);
if (len != 0x8000)
error("Invalid ROM file (%s) size (%d), must be 32768 bytes", av[1], (int)len);
uint16_t csum = 0;
for (int i = 0x0; i < 0x8000; i++)
csum += rom[i];
uint8_t* opts = rom + 0x8000;
opts[0] = 0xfc;
opts[1] = 0x39;
opts[2] = 0x01;
opts[120] = 0xdf;
opts[123] = 0x20;
opts[124] = csum;
opts[125] = csum >> 8;
opts[121] = 0x91 ^ opts[124];
opts[122] = 0x0b ^ opts[125];
opts[126] = 0x44; // IAP tool identifier (will be overwritten by bootloader to 0x49)
opts[127] = 0xaa;
fd = open(av[2], O_WRONLY | O_CREAT | O_TRUNC, 0666);
if (fd >= 0) {
ssize_t wr = write(fd, rom, 0x8100);
syscall_error(wr < 0, "write failed");
close(fd);
}
return 0;
}