summaryrefslogtreecommitdiff
path: root/firmware/src/picc/openpicc.c
blob: 54139a9c4f80387dcb153370213ff8b60afae84e (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
/* Main state machine and register implementation for OpenPICC
 * (C) 2006 by Harald Welte <hwelte@hmw-consulting.de> */

#include <sys/types.h>
#include <openpcd.h>
#include <openpicc_regs.h>
#include <openpicc.h>
#include <os/req_ctx.h>
#include <os/usb_handler.h>

#include "opicc_reg.h"

/********************************************************************
 * OpenPICC Register set
 ********************************************************************/

#ifdef DEBUG
/* Our registers, including their power-up default values */
static u_int16_t opicc_regs[_OPICC_NUM_REGS] = {
	[OPICC_REG_14443A_UIDLEN]	= 4,
	[OPICC_REG_14443A_FDT0]		= 1236,
	[OPICC_REG_14443A_FDT1]		= 1172,
	[OPICC_REG_14443A_STATE]	= ISO14443A_ST_POWEROFF,
	[OPICC_REG_14443A_ATQA]		= 0x0001,
	[OPICC_REG_RX_CLK_DIV]		= 32,
	[OPICC_REG_RX_CLK_PHASE]	= 0,
	[OPICC_REG_RX_CONTROL]		= 0,
	[OPICC_REG_TX_CLK_DIV]		= 16,
	[OPICC_REG_TX_CONTROL]		= 0,
	[OPICC_REG_RX_COMP_LEVEL]	= 0,
};

u_int16_t opicc_reg_read(enum opicc_reg reg)
{
	if (reg < _OPICC_NUM_REGS)
		return opicc_regs[reg];
	return 0;
}

void opicc_reg_write(enum opicc_reg reg, u_int16_t val)
{
	if (reg < _OPICC_NUM_REGS)
		opicc_regs[reg] = val;
	return;
}
#endif

/********************************************************************
 * OpenPICC USB Commandset (access to register set, ...)
 ********************************************************************/

static int opicc_reg_usb_in(struct req_ctx *rctx)
{
	struct openpcd_hdr *poh = (struct openpcd_hdr *) &rctx->data[0];
	u_int16_t *val16 = (u_int16_t *) poh->data;
	
	poh->val = 0;
	rctx->tot_len = sizeof(*poh);

	switch (poh->cmd) {
	case OPENPCD_CMD_PICC_REG_READ:
		*val16 = opicc_reg_read(poh->reg);
		rctx->tot_len += sizeof(u_int16_t);
		poh->flags |= OPENPCD_FLAG_RESPOND;
		break;
	case OPENPCD_CMD_PICC_REG_WRITE:
		if (rctx->tot_len < sizeof(*poh) + sizeof(u_int16_t)) {
			/* we only have an 8bit write */
			opicc_reg_write(poh->reg, poh->val);
		} else
			opicc_reg_write(poh->reg, *val16);
		break;
	default:
		return USB_ERR(USB_ERR_CMD_UNKNOWN);
	}
	
	if (poh->flags & OPENPCD_FLAG_RESPOND)
		return USB_RET_RESPOND;

	return 0;
}

void opicc_usbapi_init(void)
{
	usb_hdlr_register(&opicc_reg_usb_in, OPENPCD_CMD_CLS_PICC);
}
personal git repositories of Harald Welte. Your mileage may vary