--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/py_avrjtag/cp_tditdo.py	Sun Feb 22 12:54:45 2009 +0800
@@ -0,0 +1,54 @@
+import cmd_proto
+
+def cp_tms(seq, nbits, data):
+    nbits_bytes = chr(nbits & 0xff) + chr(nbits >> 8)
+    cmd = cmd_proto.cmd(seq, cmd_proto.CPCMD_SHIFT_TDI_TDO,
+                        nbits_bytes + data)
+    frame = cmd.to_frame()
+    return frame
+
+def get_reply(fo):
+    import fcntl, os
+    import time
+    
+    reply = ''
+    fcntl.fcntl(fo.fileno(), fcntl.F_SETFL, os.O_NONBLOCK)
+    while True:
+        try:
+            s = os.read(fo.fileno(), 256)
+        except OSError:
+            time.sleep(0.13)
+            try:
+                s = os.read(fo.fileno(), 256)
+            except OSError:
+                break
+            pass
+        reply = reply + s
+        pass
+    return reply
+
+if __name__ == '__main__':
+    import sys
+
+    if len(sys.argv) != 2:
+        print >> sys.stderr, 'Usage: prog <port device>'
+        sys.exit(1)
+        pass
+    
+    port = sys.argv[1]
+    
+    fo = open(port, 'r+b')
+    cmd_str = cp_tms(12, 37, 'hello')
+    fo.write(cmd_str)
+    fo.flush()
+    
+    frame = get_reply(fo)
+    cmd = cmd_proto.cmd()
+    r = cmd.from_frame(frame)
+    if r:
+        print 'frame error %s' % (repr(frame))
+    else:
+        print repr(cmd)
+        pass
+    pass
+