usbiodump.java

usbio Ver 2.40 source code!!! 做USB开发的值得

package de.thesycon.usbiodemo.usbioapp;
import de.thesycon.usbio.UsbIo;
import de.thesycon.usbio.UsbIoBuf;
import de.thesycon.usbio.UsbIoReader;
import de.thesycon.usbio.structs.USBIO_ISO_PACKET;
import de.thesycon.usbio.structs.USBIO_ISO_TRANSFER;

public class UsbIoDump extends UsbIoReader {

	protected PipeDialog mainFrame;
	public boolean print = true;

	int PrintPos = 0;


	public UsbIoDump(PipeDialog mainFrame) {
		super();
		this.mainFrame = mainFrame;
	}

	public void processBuffer(UsbIoBuf Buf) {
		Buf.NumberOfBytesToTransfer = Buf.Size;
		Buf.BytesTransferred = 0;
		Buf.OperationFinished = false;

		if ((mainFrame.mPipeInfo.PipeType & 3) == 1) {
			// iso
			int IsoHeaderSize = mainFrame.mIsoHeaderSize;
			int NbOfPackets = Integer.parseInt(mainFrame.mBufferPage.mNumberOfIsoPacketsPerBufferTF.getText());
			int IsoPacketSize = mainFrame.mPipeInfo.MaximumPacketSize;

			USBIO_ISO_TRANSFER iostrans = new USBIO_ISO_TRANSFER();

			iostrans.NumberOfPackets = NbOfPackets;
			iostrans.Flags= 0x30000;
			iostrans.StartFrame=0;
			iostrans.ErrorCount=0;
			System.arraycopy(iostrans.buildByteArray(),0,Buf.BufferMem,0,USBIO_ISO_TRANSFER.SIZE);
			USBIO_ISO_PACKET Packet = new USBIO_ISO_PACKET();
			int ofs = IsoHeaderSize;
			int pos = USBIO_ISO_TRANSFER.SIZE;

			for (int i=0;i<NbOfPackets;i++) {
				Packet.Offset = ofs;
				Packet.Length = IsoPacketSize;
				Packet.Status = 0;
				System.arraycopy(Packet.buildByteArray(),0,Buf.BufferMem,pos,USBIO_ISO_PACKET.SIZE);
				pos += USBIO_ISO_PACKET.SIZE;
				ofs += IsoPacketSize;
			}
		} else {
			// bulk or interrupt ...

		}
	}

	public void processData(UsbIoBuf Buf) {
		if (print) {
			if ((mainFrame.mPipeInfo.PipeType & 3 ) == 1) {
				// iso
				if (Buf.Status == 0 ) {
					mainFrame.mainFrame.printOutput("*");
					PrintPos++;
					if (PrintPos >= 32) {
						mainFrame.mainFrame.printOutput("\n");
						PrintPos=0;
					}
				}
				byte[] data = new byte[USBIO_ISO_TRANSFER.SIZE];
				byte[] packet = new byte[USBIO_ISO_PACKET.SIZE];
				System.arraycopy(Buf.BufferMem,0,data,0,USBIO_ISO_TRANSFER.SIZE);
				USBIO_ISO_TRANSFER trans = new USBIO_ISO_TRANSFER();
				USBIO_ISO_PACKET isopacket = new USBIO_ISO_PACKET();
				trans.parseByteArray(data);
				int pos = USBIO_ISO_TRANSFER.SIZE;

				for (int i=0;i<trans.NumberOfPackets;i++) {
					System.arraycopy(Buf.BufferMem,pos,packet,0,USBIO_ISO_PACKET.SIZE);
					isopacket.parseByteArray(packet);
					if (isopacket.Status != 0) {
						mainFrame.mainFrame.printError("",isopacket.Status);
					}
					pos += USBIO_ISO_PACKET.SIZE;
				}
			} else {
				if (Buf.Status == USBIO_ERR_SUCCESS) {
					mainFrame.mainFrame.printOutput("Bytes transferred: " + Buf.BytesTransferred + "\n");
				} else {
					mainFrame.mainFrame.printOutput("Bytes transferred: " + Buf.BytesTransferred + "  Status: " + UsbIo.errorText(Buf.Status) + "\n");
				}
				dumpHex(Buf.BufferMem,Buf.BytesTransferred);
			}
		}
	}

	public void bufErrorHandler(UsbIoBuf Buf) {
		if ( Buf.Status != USBIO_ERR_SUCCESS ) {
			// print error
			// suppress CANCELED because it is caused by ABORT_PIPE
			if ( Buf.Status != USBIO_ERR_CANCELED ) {
				mainFrame.mainFrame.printError("Buf Error: ",Buf.Status);
			}
		}
	}

	// virtual function, called in the context of worker thread
	public void onThreadExit()
	{
		mainFrame.mainFrame.printOutput("Worker-thread terminated.\n");
		// notify owning dialog, should be the last call
		mainFrame.onThreadExit();
	}

	public void dumpHex(byte[] data, int size) {
		int pos = 0;
		String hex = "";
		String bin = "";
		int end;
		while (pos < size) {
			if ((size - pos) < 16) {
				end = (size - pos);
			} else {
				end =16;
			}
			hex = "";
			bin = "";
			for (int i = 0 ; i < end ; i++) {
				hex += UsbIoApp.byteToString(data[pos+i]);
				hex += " ";
				if ((i % 4) == 3) {
					hex += " ";
				}
				if ((data[pos+i] >= 0x20) && (data[pos+i] <= 0x7F)) {
					bin += (new Character((char)data[pos+i])).toString();
				} else {
					bin += ".";
				}
			}
			mainFrame.mainFrame.printOutput(UsbIoApp.shortToString((short)pos) + ": " + hex + " " + bin + "\n");
			if (pos>=64) {
				mainFrame.mainFrame.printOutput("...\n");
				return;
			}
			pos += 16;
		}

	}
}