/*
  phat patch! woo -bushing
 */

#include <errno.h>
#include <fcntl.h>
#include <sys/mman.h>
#include <unistd.h>
#include <stdio.h>
#include <string.h>
#include <stdlib.h>

#define WRITE(x,y) flash[((x & 0x7FFF)<<1) | ((x & 0x8000) >> 15)]=(y) 
#define READ(x) flash[((x & 0x7FFF)<<1) | ((x & 0x8000) >> 15)] 

#define UADDR1 (0x2aa)
#define UADDR2 (0x555)

#define UNLOCK flash[UADDR1] = 0xAA; flash[UADDR2] = 0x55

int main(int argc, char *argv[])
{
  int fd_mem;
  unsigned int addr;
  unsigned short val;
  volatile unsigned short *flash;

  printf("Test program...\n");

  if (argc<2) {
    printf("Usage: phatpatch addr val\n");
    exit(-1);
  }

  if ((fd_mem = open("/dev/mem", O_RDWR |O_SYNC)) < 0) {
    perror("Can not open /dev/mem");
    exit(1);
  }

  flash = mmap((void *)0x00000000, 0x20000, PROT_WRITE | PROT_READ, MAP_SHARED,
  fd_mem, (off_t) (0x00000000));
  if (flash == MAP_FAILED) {
    perror("Error MMAP /dev/mem");
    exit(1);
  }

  addr = strtoul(argv[1], NULL, 16);
  val = (unsigned short)(strtoul(argv[2], NULL, 16)&0xffff);

  WRITE(addr, val);

  munmap((void *) flash, 0x20000);
  close(fd_mem);
  return 0;
}