/*
 * Copyright 2017 Toradex AG.
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

/*
 * Running this will set GPR9/GPR10 to values which will make the module
 * go to recovery mode on next reboot.
 * It has the same effect as 'bmode usb noreset' in U-Boot
 *
 * $ arm-linux-gnueabihf-gcc -o bmode_usb bmode_usb.c
 * $ arm-linux-gnueabihf-strip bmode_usb
 */

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

#ifdef MX6
#define SRC_BASE_ADDR		0x020D8000
#define SRC_GPR9_OFF		(0x40/4)
#define SRC_GPR10_OFF		(0x44/4)
#define SRC_GPR9_OFF_VALUE	0x10
#define SRC_GPR10_OFF_VALUE	0x10000000
#elif defined(MX6ULL)
#define SRC_BASE_ADDR		0x020D8000
#define SRC_GPR9_OFF		(0x40/4)
#define SRC_GPR10_OFF		(0x44/4)
#define SRC_GPR9_OFF_VALUE	0x20
#define SRC_GPR10_OFF_VALUE	0x10000000
#endif

int main(void)
{
#if ( defined(MX6) | defined(MX6ULL)  )
	int fd;
	unsigned reg;
	unsigned *src;

	fd = open("/dev/mem", O_RDWR);
	src = (unsigned *)mmap(0, SRC_GPR10_OFF + 4, PROT_READ|PROT_WRITE,
			       MAP_SHARED, fd, SRC_BASE_ADDR);
	if(src == NULL) {
		printf("Failed to mmap register\n");
		return -1;
	}

	src[SRC_GPR9_OFF] = SRC_GPR9_OFF_VALUE;
	src[SRC_GPR10_OFF] |= SRC_GPR10_OFF_VALUE;

	printf("Next reboot (not powercycle!) will boot to recovery mode\n");
#else
	printf("Not supported on this platform\n");
#endif
	return 0;
}