started code to set ir ...

diff --git a/jtag.c b/jtag.c
index ca2e683..2e8298c 100644 (file)
--- 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,6 +228,33 @@ int jtag_chain_init(t_jtag *jtag) {
 
 }
 
+int jtag_set_ir(char *s,int bitlen) {
+
+       u8 ir[MAXDEV*MAX_IR_LEN/8];
+       int count;
+
+       if(biten>=MAXDEV*MAX_IR_LEN) {
+               printf("instruction register too big!\n");
+               return -1;
+       }
+
+       memset(ir,0,MAXDEV*MAX_IR_LEN/8*sizeof(u8));
+
+       while(bitlen) {
+               ir[count/8]|=p[count] ... HIER WEITER ..;
+               count+=1;
+               bitlen-=1;
+       }
+
+       jtag_enter_shift_ir();
+
+       while(len--)
+
+       jtag_leave_shift_ir();
+       return 0;
+
+}
+
 int main(int argc,char **argv) {
 
        t_jtag jtag;