Subversion Repositories s80186

/* Copyright 2012 Brian Swetland <swetland@frotz.net>
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *     http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */
 
#include <stdio.h>
#include <stdlib.h>
 
#include "jtag.h"
 
int jtag_dr_8x4(unsigned *out) {
	unsigned bits = 0;
	unsigned tmp;
	int n, r;
 
	for (n = 0; n < 8; n++) {
		if ((r = jtag_dr(4, 0, &tmp)) < 0) return r;
		bits |= (tmp <<= (n * 4));
	}
	*out = bits;
	return 0;
}
 
/* number of bits needed given a max value 1-255 */
unsigned needbits(unsigned max) {
	if (max > 127) return 8;
	if (max > 63) return 7;
	if (max > 31) return 6;
	if (max > 15) return 5;
	if (max > 7) return 4;
	if (max > 3) return 3;
	if (max > 1) return 2;
	return 1;
}
 
static unsigned ir_width = 10;
 
static unsigned hub_version = 0;
static unsigned hub_nodecount = 0;
static unsigned hub_mfg = 0;
 
static unsigned vir_width = 0;
static unsigned vir_width_addr = 0;
static unsigned vir_width_ir = 0;
static unsigned vir_addr = 0;
 
 
int jtag_vir(unsigned vir) {
	int r;
	if ((r = jtag_ir(ir_width, 14)) < 0) return r;
	if ((r = jtag_dr(vir_width, vir_addr | vir, 0)) < 0) return r;
	return 0;
}
 
int jtag_vdr(unsigned sz, unsigned bits, unsigned *out) {
	int r;
	if ((r = jtag_ir(ir_width, 12)) < 0) return r;
	if ((r = jtag_dr(sz, bits, out)) < 0) return r;
	return 0;
}
 
int jtag_open_virtual_device(unsigned iid) {
	unsigned n, bits;
	int r;
 
	if ((r = jtag_open()) < 0) return r;
 
	if ((r = jtag_reset()) < 0) return r;
 
	/* select empty node_addr + node_vir -- all zeros */
	if ((r = jtag_ir(ir_width, 14)) < 0) return r;
	if ((r = jtag_dr(32, 0, 0)) < 0) return r;
 
	/* select vdr - this will be the hub info (addr=0,vir=0) */
	if ((r = jtag_ir(ir_width, 12)) < 0) return r;
 
	/* read hub info */
	if ((r = jtag_dr_8x4(&bits)) < 0) return r;
	hub_version = (bits >> 27) & 0x1F;
	hub_nodecount = (bits >> 19) & 0xFF;
	hub_mfg = (bits >> 8) & 0x7FF;
 
	if (hub_mfg != 0x06e) {
		fprintf(stderr,"HUB:    Cannot Find Virtual JTAG HUB\n");
		return -1;
	}
 
	/* altera docs claim this field is the sum of M bits (VIR field) and
	 * N bits (ADDR field), but empirical evidence suggests it is actually
	 * just the width of the ADDR field and the docs are wrong...
	 */
	vir_width_ir = bits & 0xFF;
	vir_width_addr = needbits(hub_nodecount);
	vir_width = vir_width_ir + vir_width_addr;
 
	for (n = 0; n < hub_nodecount; n++) {
		unsigned node_ver, node_id, node_mfg, node_iid;
		if ((r = jtag_dr_8x4(&bits)) < 0) return r;
		node_ver = (bits >> 27) & 0x1F;
		node_id = (bits >> 19) & 0xFF;
		node_mfg = (bits >> 8) & 0x7FF;
		node_iid = bits & 0xFF;
 
		if ((node_id == 0x08) && (node_iid) == iid) {
			vir_addr = (n + 1) << vir_width_ir;
		}
	}
 
	if ((vir_addr == 0) && (iid < 256)) {
		fprintf(stderr,"ERROR: IID 0x%02x not found\n", iid);
		return -1;
	}
	return 0;
}