set svn:ignore

[proxmark3-svn] / armsrc / util.c

//-----------------------------------------------------------------------------\r
// Utility functions used in many places, not specific to any piece of code.\r
// Jonathan Westhues, Sept 2005\r
//-----------------------------------------------------------------------------\r
#include <proxmark3.h>\r
#include "apps.h"\r
\r
void *memcpy(void *dest, const void *src, int len)\r
{\r
	BYTE *d = dest;\r
	const BYTE *s = src;\r
	while((len--) > 0) {\r
		*d = *s;\r
		d++;\r
		s++;\r
	}\r
	return dest;\r
}\r
\r
void *memset(void *dest, int c, int len)\r
{\r
	BYTE *d = dest;\r
	while((len--) > 0) {\r
		*d = c;\r
		d++;\r
	}\r
	return dest;\r
}\r
\r
int memcmp(const void *av, const void *bv, int len)\r
{\r
	const BYTE *a = av;\r
	const BYTE *b = bv;\r
\r
	while((len--) > 0) {\r
		if(*a != *b) {\r
			return *a - *b;\r
		}\r
		a++;\r
		b++;\r
	}\r
	return 0;\r
}\r
\r
int strlen(char *str)\r
{\r
	int l = 0;\r
	while(*str) {\r
		l++;\r
		str++;\r
	}\r
	return l;\r
}\r
\r
char* strncat(char *dest, const char *src, unsigned int n)\r
{\r
	unsigned int dest_len = strlen(dest);\r
	unsigned int i;\r
	\r
	for (i = 0 ; i < n && src[i] != '\0' ; i++)\r
		dest[dest_len + i] = src[i];\r
	dest[dest_len + i] = '\0';\r
	\r
	return dest;\r
}\r
\r
void num_to_bytes(uint64_t n, size_t len, byte_t* dest)\r
{\r
	while (len--) {\r
		dest[len] = (byte_t) n;\r
		n >>= 8;\r
	}\r
}\r
\r
uint64_t bytes_to_num(byte_t* src, size_t len)\r
{\r
	uint64_t num = 0;\r
	while (len--)\r
	{\r
		num = (num << 8) | (*src);\r
		src++;\r
	}\r
	return num;\r
}\r
\r
void LEDsoff()\r
{\r
	LED_A_OFF();\r
	LED_B_OFF();\r
	LED_C_OFF();\r
	LED_D_OFF();\r
}\r
\r
// LEDs: R(C) O(A) G(B) -- R(D) [1, 2, 4 and 8]\r
void LED(int led, int ms)\r
{\r
	if (led & LED_RED)\r
		LED_C_ON();\r
	if (led & LED_ORANGE)\r
		LED_A_ON();\r
	if (led & LED_GREEN)\r
		LED_B_ON();\r
	if (led & LED_RED2)\r
		LED_D_ON();\r
\r
	if (!ms)\r
		return;\r
\r
	SpinDelay(ms);\r
\r
	if (led & LED_RED)\r
		LED_C_OFF();\r
	if (led & LED_ORANGE)\r
		LED_A_OFF();\r
	if (led & LED_GREEN)\r
		LED_B_OFF();\r
	if (led & LED_RED2)\r
		LED_D_OFF();\r
}\r
\r
\r
// Determine if a button is double clicked, single clicked,\r
// not clicked, or held down (for ms || 1sec)\r
// In general, don't use this function unless you expect a\r
// double click, otherwise it will waste 500ms -- use BUTTON_HELD instead\r
int BUTTON_CLICKED(int ms)\r
{\r
	// Up to 500ms in between clicks to mean a double click\r
	int ticks = (48000 * (ms ? ms : 1000)) >> 10;\r
\r
	// If we're not even pressed, forget about it!\r
	if (!BUTTON_PRESS())\r
		return BUTTON_NO_CLICK;\r
\r
	// Borrow a PWM unit for my real-time clock\r
	AT91C_BASE_PWMC->PWMC_ENA = PWM_CHANNEL(0);\r
	// 48 MHz / 1024 gives 46.875 kHz\r
	AT91C_BASE_PWMC_CH0->PWMC_CMR = PWM_CH_MODE_PRESCALER(10);\r
	AT91C_BASE_PWMC_CH0->PWMC_CDTYR = 0;\r
	AT91C_BASE_PWMC_CH0->PWMC_CPRDR = 0xffff;\r
\r
	WORD start = AT91C_BASE_PWMC_CH0->PWMC_CCNTR;\r
\r
	int letoff = 0;\r
	for(;;)\r
	{\r
		WORD now = AT91C_BASE_PWMC_CH0->PWMC_CCNTR;\r
\r
		// We haven't let off the button yet\r
		if (!letoff)\r
		{\r
			// We just let it off!\r
			if (!BUTTON_PRESS())\r
			{\r
				letoff = 1;\r
\r
				// reset our timer for 500ms\r
				start = AT91C_BASE_PWMC_CH0->PWMC_CCNTR;\r
				ticks = (48000 * (500)) >> 10;\r
			}\r
\r
			// Still haven't let it off\r
			else\r
				// Have we held down a full second?\r
				if (now == (WORD)(start + ticks))\r
					return BUTTON_HOLD;\r
		}\r
\r
		// We already let off, did we click again?\r
		else\r
			// Sweet, double click!\r
			if (BUTTON_PRESS())\r
				return BUTTON_DOUBLE_CLICK;\r
\r
			// Have we ran out of time to double click?\r
			else\r
				if (now == (WORD)(start + ticks))\r
					// At least we did a single click\r
					return BUTTON_SINGLE_CLICK;\r
\r
		WDT_HIT();\r
	}\r
\r
	// We should never get here\r
	return BUTTON_ERROR;\r
}\r
\r
// Determine if a button is held down\r
int BUTTON_HELD(int ms)\r
{\r
	// If button is held for one second\r
	int ticks = (48000 * (ms ? ms : 1000)) >> 10;\r
\r
	// If we're not even pressed, forget about it!\r
	if (!BUTTON_PRESS())\r
		return BUTTON_NO_CLICK;\r
\r
	// Borrow a PWM unit for my real-time clock\r
	AT91C_BASE_PWMC->PWMC_ENA = PWM_CHANNEL(0);\r
	// 48 MHz / 1024 gives 46.875 kHz\r
	AT91C_BASE_PWMC_CH0->PWMC_CMR = PWM_CH_MODE_PRESCALER(10);\r
	AT91C_BASE_PWMC_CH0->PWMC_CDTYR = 0;\r
	AT91C_BASE_PWMC_CH0->PWMC_CPRDR = 0xffff;\r
\r
	WORD start = AT91C_BASE_PWMC_CH0->PWMC_CCNTR;\r
\r
	for(;;)\r
	{\r
		WORD now = AT91C_BASE_PWMC_CH0->PWMC_CCNTR;\r
\r
		// As soon as our button let go, we didn't hold long enough\r
		if (!BUTTON_PRESS())\r
			return BUTTON_SINGLE_CLICK;\r
\r
		// Have we waited the full second?\r
		else\r
			if (now == (WORD)(start + ticks))\r
				return BUTTON_HOLD;\r
\r
		WDT_HIT();\r
	}\r
\r
	// We should never get here\r
	return BUTTON_ERROR;\r
}\r
\r
// attempt at high resolution microsecond timer\r
// beware: timer counts in 21.3uS increments (1024/48Mhz)\r
void SpinDelayUs(int us)\r
{\r
	int ticks = (48*us) >> 10;\r
\r
	// Borrow a PWM unit for my real-time clock\r
	AT91C_BASE_PWMC->PWMC_ENA = PWM_CHANNEL(0);\r
	// 48 MHz / 1024 gives 46.875 kHz\r
	AT91C_BASE_PWMC_CH0->PWMC_CMR = PWM_CH_MODE_PRESCALER(10);\r
	AT91C_BASE_PWMC_CH0->PWMC_CDTYR = 0;\r
	AT91C_BASE_PWMC_CH0->PWMC_CPRDR = 0xffff;\r
\r
	WORD start = AT91C_BASE_PWMC_CH0->PWMC_CCNTR;\r
\r
	for(;;) {\r
		WORD now = AT91C_BASE_PWMC_CH0->PWMC_CCNTR;\r
		if (now == (WORD)(start + ticks))\r
			return;\r
\r
		WDT_HIT();\r
	}\r
}\r
\r
void SpinDelay(int ms)\r
{\r
  // convert to uS and call microsecond delay function\r
	SpinDelayUs(ms*1000);\r
}\r
\r
/* Similar to FpgaGatherVersion this formats stored version information\r
 * into a string representation. It takes a pointer to the struct version_information,\r
 * verifies the magic properties, then stores a formatted string, prefixed by\r
 * prefix in dst.\r
 */\r
void FormatVersionInformation(char *dst, int len, const char *prefix, void *version_information)\r
{\r
	struct version_information *v = (struct version_information*)version_information;\r
	dst[0] = 0;\r
	strncat(dst, prefix, len);\r
	if(v->magic != VERSION_INFORMATION_MAGIC) {\r
		strncat(dst, "Missing/Invalid version information", len);\r
		return;\r
	}\r
	if(v->versionversion != 1) {\r
		strncat(dst, "Version information not understood", len);\r
		return;\r
	}\r
	if(!v->present) {\r
		strncat(dst, "Version information not available", len);\r
		return;\r
	}\r
	\r
	strncat(dst, v->svnversion, len);\r
	if(v->clean == 0) {\r
		strncat(dst, "-unclean", len);\r
	} else if(v->clean == 2) {\r
		strncat(dst, "-suspect", len);\r
	}\r
	\r
	strncat(dst, " ", len);\r
	strncat(dst, v->buildtime, len);\r
}\r