X-Git-Url: https://www.hackdaworld.org/gitweb/?p=my-code%2Fpnx.git;a=blobdiff_plain;f=jtag.c;h=2497cf78dbd935c1a632cdc53f3a0307b82c4af6;hp=ca2e683995e83f5ebb238762c36786216e1a6953;hb=6b2243de35d3e030094e349ce4515442c27bccb9;hpb=6f15628e4735a47b9817673680d8efd2688a2923

diff --git a/jtag.c b/jtag.c
index ca2e683..2497cf7 100644
--- a/jtag.c
+++ b/jtag.c
@@ -175,6 +175,22 @@ int jtag_read_data(u8 *p,int bitlen) {
 
 }
 
+int jtag_write_data(u8 *p,int bitlen) {
+
+	int count;
+
+	count=0;
+
+	while(bitlen) {
+		jtag_clock(0,p[count/8]&(1<<count)?1:0);
+		bitlen-=1;
+		count+=1;
+	}
+
+	return 0;
+
+}
+
 int jtag_chain_init(t_jtag *jtag) {
 
 	int i;
@@ -212,9 +228,40 @@ int jtag_chain_init(t_jtag *jtag) {
 
 }
 
+int jtag_set_ir(char *s,int bitlen) {
+
+	u8 ir[MAXDEV*MAXIRLEN/8];
+	int count;
+
+	if(bitlen>=MAXDEV*MAXIRLEN) {
+		printf("instruction register too big!\n");
+		return -1;
+	}
+
+	memset(ir,0,MAXDEV*MAXIRLEN/8*sizeof(u8));
+
+	printf("ir to set: ");
+	while(bitlen) {
+		ir[count/8]|=(s[count]<<(count%8));
+		printf("%d",ir[count/8]&(1<<count%8)?1:0);
+		count+=1;
+		bitlen-=1;
+	}
+	printf("\n");
+
+	jtag_enter_shift_ir();
+	jtag_write_data(ir,bitlen);
+	jtag_leave_shift_ir();
+
+	return 0;
+
+}
+
 int main(int argc,char **argv) {
 
 	t_jtag jtag;
+	u8 io[256];
+	int i;
 
 	memset(&jtag,0,sizeof(t_jtag));
 
@@ -230,6 +277,16 @@ int main(int argc,char **argv) {
 	jtag_chain_init(&jtag);
 	printf("done\n\n");
 
+	printf("testing some instructions ...\n\n");
+	jtag_set_ir("000001000001",12);
+	jtag_enter_shift_dr();
+	jtag_read_data(io,64);
+	for(i=0;i<64;i++) {
+		printf("%d",io[i/8]&(1<<(i%8))?1:0);
+	}
+	printf("\n");
+	jtag_leave_shift_dr();
+
 	return 0;
 
 }