diff options
Diffstat (limited to 'library/SIMTRACE_Emulation.ttcn')
| -rw-r--r-- | library/SIMTRACE_Emulation.ttcn | 175 |
1 files changed, 175 insertions, 0 deletions
diff --git a/library/SIMTRACE_Emulation.ttcn b/library/SIMTRACE_Emulation.ttcn new file mode 100644 index 00000000..c9076089 --- /dev/null +++ b/library/SIMTRACE_Emulation.ttcn @@ -0,0 +1,175 @@ +module SIMTRACE_Emulation { + +import from General_Types all; +import from Osmocom_Types all; +import from Misc_Helpers all; + +import from USB_PortType all; +import from USB_Types all; +import from USB_Templates all; +import from USB_Component all; +import from USB_PortTypes all; + +import from SIMTRACE_Types all; +import from SIMTRACE_Templates all; + +/* one USB interface */ +type component ST_Emulation_CT extends USB_CT { + var integer g_ep_in; + var integer g_ep_out; + var integer g_ep_irq; + var USB_IF_Params g_pars; + + port ST_USER_PT INOUT; + port ST_USER_PT IRQ; +}; + +type port ST_USER_PT message { + inout SIMTRACE_PDU; +} with { extension "internal" }; + +/* configuration for a ST_Emulation_CT */ +type record USB_IF_Params { + USB_Device_Match usb_dev_match, + integer usb_if_nr +}; + +private const octetstring c_oct261 := '000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000000'O; + +private function f_usb_submit_xfer(USB_endpoint ep, octetstring data := c_oct261, + USB_transfer_type ttype := USB_TRANSFER_TYPE_BULK, + integer tout_ms := 30000) runs on USB_CT +{ + var integer req_hdl := f_usb_get_req_hdl(); + var USB_transfer xfer := { + device_hdl := g_dev_hdl, + transfer_hdl := req_hdl, + endpoint := ep, + ttype := ttype, + data := data, + timeout_msec := tout_ms + }; + USB.send(xfer); +} + +/* open libusb device; claim interface; resolve endpoints; submit IN/IRQ transfers */ +function main(USB_IF_Params pars) runs on ST_Emulation_CT { + var USB_Descriptor_Node root; + var integer i_config; + var integer i; + + g_pars := pars; + + f_usb_init(g_pars.usb_dev_match); + + i_config := f_usb_get_config(); + log("USB Configuration: ", i_config); + + root := f_usb_get_desc_tree(); + log(root); + + /* iterate over list of interfaces in current configuration */ + for (i := 0; i < lengthof(root.children[i_config].children); i:=i+1) { + var USB_Descriptor_Node ifn := root.children[i_config].children[i]; + var USB_InterfaceDescriptor ifd := ifn.desc.interface; + var integer j; + if (ifd.bInterfaceNumber != g_pars.usb_if_nr) { + continue; + } + /* determine endpoints inside interface */ + for (j := 0; j < lengthof(ifn.children); j:=j+1) { + if (ischosen(ifn.children[j].desc.endpoint)) { + var USB_EndpointDescriptor epd := ifn.children[j].desc.endpoint; + select (epd.bmAttributes.TranferType) { + case (USB_EpTransfer_BULK) { + if (epd.bEndpointAddress and4b '80'O == '80'O) { + g_ep_in := oct2int(epd.bEndpointAddress); + } else { + g_ep_out := oct2int(epd.bEndpointAddress); + } + } + case (USB_EpTransfer_INTERRUPT) { + g_ep_irq := oct2int(epd.bEndpointAddress); + } + } + } + } + } + + log("USB Endpoints found: IN: ", int2oct(g_ep_in, 1), ", OUT: ", int2oct(g_ep_out, 1), + " IRQ: ", int2oct(g_ep_irq, 1)); + + f_usb_claim_interface(g_dev_hdl, g_pars.usb_if_nr); + + /* submit xfer fro IN and IRQ endpoints */ + f_usb_submit_xfer(g_ep_in); + f_usb_submit_xfer(g_ep_irq, ttype := USB_TRANSFER_TYPE_INTERRUPT); + + var USB_transfer_compl tc; + var SIMTRACE_PDU stpdu_out, stpdu_in; + while (true) { + alt { + [] USB.receive(tr_UsbXfer_compl(g_ep_out, USB_TRANSFER_TYPE_BULK, + USB_TRANSFER_COMPLETED, g_dev_hdl, ?)) { + /* do nothing; normal completion of OUT transfer */ + } + [] USB.receive(tr_UsbXfer_compl(g_ep_in, USB_TRANSFER_TYPE_BULK, + USB_TRANSFER_COMPLETED, g_dev_hdl, ?)) -> value tc { + /* Submit another IN transfer */ + f_usb_submit_xfer(g_ep_in); + stpdu_in := dec_SIMTRACE_PDU(tc.data); + INOUT.send(stpdu_in); + } + [] USB.receive(tr_UsbXfer_compl(g_ep_irq, USB_TRANSFER_TYPE_INTERRUPT, + USB_TRANSFER_COMPLETED, g_dev_hdl, ?))-> value tc { + /* Submit another IRQ transfer */ + f_usb_submit_xfer(g_ep_irq, ttype := USB_TRANSFER_TYPE_INTERRUPT); + stpdu_in := dec_SIMTRACE_PDU(tc.data); + IRQ.send(stpdu_in); + } + [] USB.receive(tr_UsbXfer_compl(g_ep_irq, USB_TRANSFER_TYPE_INTERRUPT, + USB_TRANSFER_TIMED_OUT, g_dev_hdl, ?)) -> value tc { + /* Submit another IRQ transfer */ + f_usb_submit_xfer(g_ep_irq, ttype := USB_TRANSFER_TYPE_INTERRUPT); + } + [] USB.receive(tr_UsbXfer_compl(?, ?, USB_TRANSFER_STALL, g_dev_hdl, ?)) -> value tc { + setverdict(fail, "Unexpected USB_TRANSFER_STALL on EP ", int2hex(tc.endpoint, 2)); + //mtc.stop; + /* Submit another IN transfer */ + f_usb_submit_xfer(tc.endpoint); + } + [] USB.receive(tr_UsbXfer_compl(?, ?, USB_TRANSFER_ERROR, g_dev_hdl, ?)) -> value tc { + setverdict(fail, "Unexpected USB_TRANSFER_ERROR on EP ", int2hex(tc.endpoint, 2)); + mtc.stop; + } + [] USB.receive(tr_UsbXfer_compl(?, ?, USB_TRANSFER_TIMED_OUT, g_dev_hdl, ?)) -> value tc { + setverdict(fail, "Unexpected USB_TRANSFER_TIMED_OUT on EP ", int2hex(tc.endpoint, 2)); + mtc.stop; + } + [] USB.receive(tr_UsbXfer_compl(?, ?, USB_TRANSFER_OVERFLOW, g_dev_hdl, ?)) -> value tc { + setverdict(fail, "Unexpected USB_TRANSFER_OVERFLOW on EP ", int2hex(tc.endpoint, 2)); + mtc.stop; + } + [] USB.receive(tr_UsbXfer_compl(?, ?, ?, g_dev_hdl, ?)) -> value tc { + setverdict(fail, "Unexpected USB Endpoint ", int2hex(tc.endpoint, 2)); + mtc.stop; + } + [] USB.receive(tr_UsbXfer_compl(?, ?, ?, ?, ?)) -> value tc { + setverdict(fail, "Unexpected USB Device ", tc.device_hdl); + mtc.stop; + } + [] USB.receive { + setverdict(fail, "Unexpected Message from USB"); + mtc.stop; + } + + + [] INOUT.receive(SIMTRACE_PDU:?) -> value stpdu_out { + f_usb_submit_xfer(g_ep_out, enc_SIMTRACE_PDU(stpdu_out), tout_ms := 3000); + } + } + } +} + + +} |