tools/rpc: Remove the desktop RPC library.

This code doesn't work well on non-real time systems. Additionally, given USB UART
is the connection of choice it makes scripts hard to use. It's better to use the
debug protocol scripts or the pyboard controller script.
This commit is contained in:
Kwabena W. Agyeman 2025-02-06 22:34:46 -08:00
parent a25a43bd58
commit 0d4a786507
7 changed files with 1 additions and 1449 deletions

View File

@ -31,7 +31,7 @@ The OpenMV firmware supports loading quantized TensorFlow Lite models. The firmw
## Interface library
The OpenMV Cam comes built-in with an RPC (Remote Python/Procedure Call) library which makes it easy to connect the OpenMV Cam to your computer, a SBC (single board computer) like the RaspberryPi or Beaglebone, or a microcontroller like the Arduino or ESP8266/32. The RPC Interface Library works over:
The OpenMV Cam comes built-in with an RPC (Remote Python/Procedure Call) library which makes it easy to connect the OpenMV Cam to another microcontroller like the Arduino or ESP8266/32. The RPC Interface Library works over:
* Async Serial (UART) - at up **7.5 Mb/s** on the OpenMV Cam H7.
* I2C Bus - at up to **1 Mb/s** on the OpenMV Cam H7.
@ -39,20 +39,11 @@ The OpenMV Cam comes built-in with an RPC (Remote Python/Procedure Call) library
* SPI Bus - at up to **20 Mb/s** on the OpenMV Cam H7.
* Up to **80 Mb/s** or **40 Mb/s** is achievable with short enough wires.
* CAN Bus - at up to **1 Mb/s** on the OpenMV Cam H7.
* USB Virtual COM Port (VCP) - at up to **12 Mb/s** on the OpenMV Cam M4/M7/H7.
* WiFi using the [WiFi Shield](https://openmv.io/collections/shields/products/wifi-shield-1) - at up to **12 Mb/s** on the OpenMV Cam M4/M7/H7.
With the RPC Library you can easily get image processing results, stream RAW or JPG image data, or have the OpenMV Cam control another Microcontroller for lower-level hardware control like driving motors.
You can find examples that run on the OpenMV Cam under `File->Examples->Remote Control` in OpenMV IDE and online [here](scripts/examples/34-Remote-Control). Finally, OpenMV provides the following libraries for interfacing your OpenMV Cam to other systems below:
* [Generic Python Interface Library for USB VCP, Ethernet/WiFi, UART, Kvarser CAN, and I2C/SPI Comms](tools/rpc/README.md)
* Provides Python code for connecting your OpenMV Cam to a Windows, Mac, or Linux computer (or RaspberryPi/Beaglebone, etc.).
* Supports USB VCP on all systems. E.g. direct USB connection to the OpenMV Cam.
* Supports Ethernet/WiFi on all systems.
* Supports RS232/RS422/RS485/TTL UARTs on all systems. E.g. the old school DB9 port on the back of a PC, USB to serial RS232/RS422/RS485/TTL adapters, and TTL serial on I/O pins on SBCs like the RaspberryPi/Beaglebone.
* Supports Kvarser CAN on Windows and Linux (Kvarser does not support Mac).
* Supports I2C/SPI on Linux SBCs like the RaspberryPi/Beaglebone, etc. (coming soon)
* [Arduino Interface Library for CAN, I2C, SPI, UART Comms](https://github.com/openmv/openmv-arduino-rpc)
* Works on all Arduino variants.
* CAN support via the MCP2515 over SPI or via the CAN peripheral on the ESP32.

View File

@ -660,45 +660,3 @@ class rpc_uart_slave(rpc_slave):
p.register(self.__uart, select.POLLIN)
p.poll(1000)
return self.get_bytes(buff, timeout_ms)
class rpc_usb_vcp_master(rpc_master):
def __init__(self): # private
import pyb
self.__usb_vcp = pyb.USB_VCP()
if omv.debug_mode():
raise OSError("You cannot use the USB VCP while the IDE is connected!")
self.__usb_vcp.setinterrupt(-1)
rpc_master.__init__(self)
def _flush(self): # protected
self.__usb_vcp.read()
def get_bytes(self, buff, timeout_ms): # protected
if self.__usb_vcp.recv(buff, timeout=timeout_ms) != len(buff):
return None
return buff
def put_bytes(self, data, timeout_ms): # protected
self.__usb_vcp.send(data, timeout=timeout_ms)
class rpc_usb_vcp_slave(rpc_slave):
def __init__(self): # private
import pyb
self.__usb_vcp = pyb.USB_VCP()
if omv.debug_mode():
raise OSError("You cannot use the USB VCP while the IDE is connected!")
self.__usb_vcp.setinterrupt(-1)
rpc_slave.__init__(self)
def _flush(self): # protected
self.__usb_vcp.read()
def get_bytes(self, buff, timeout_ms): # protected
if self.__usb_vcp.recv(buff, timeout=timeout_ms) != len(buff):
return None
return buff
def put_bytes(self, data, timeout_ms): # protected
self.__usb_vcp.send(data, timeout=timeout_ms)

View File

@ -1,212 +0,0 @@
# OpenMV Remote Python Call Library
The `rpc` module on the OpenMV Cam allows you to connect your OpenMV Cam to another microcontroller or computer and execute remote python (or procedure) calls on your OpenMV Cam. The `rpc` module also allows for the reverse too if you want your OpenMV Cam to be able to execute remote procedure (or python) calls on another microcontroller or computer.
For computer control the [rpc](rpc.py) python module in this directory implements the OpenMV `rpc` protocol for control of an OpenMV Cam over USB VCP (i.e. a USB serial port) or over Ethernet/WiFi (i.e. over sockets).
# Library Dependencies
The OpenMV Cam `rpc` library on the computer only depends on [pyserial](https://pythonhosted.org/pyserial/). All other modules used by it come installed with python. To get `pyserial` just do:
pip install pyserial
However, the examples depend on [pygame](https://www.pygame.org/news) so you need to install pygame too:
pip install pygame
Because the interface library is implemented in pure python with no external dependencies it works on Windows, Mac, and Linux.
## UART Support
pySerial provides support for pure USB virtual COM ports, USB to RS232/RS422/RS485/TTL COM ports, and standard RS232/RS422/RS485/TTL COM ports. Please use the `rpc_usb_vcp_master` and `rpc_usb_vcp_slave` for pure USB virtual COM port communication and `rpc_uart_master` and `rpc_uart_slave` for USB to RS232/RS422/RS485/TTL COM ports and standard RS232/RS422/RS485/TTL COM ports.
### USB to Serial Converter Issues
Pure hardware RS232/RS422/RS485/TTL COM ports should work using the `rpc_uart_master` and `rpc_uart_slave` interfaces without issues. However, FTDI like USB to serial converter chips may add unexpected latency to communication. In particular, FTDI chips have a latency timer which is used to buffer bytes for transmission over USB to improve bandwidth... but, that also increases the worse case latency of a single byte being sent over USB to **16 ms** by default. You need to reduce the latency timer to **1 ms** as detailed below or the interface library will fail to work:
* https://stackoverflow.com/questions/54230836/inconsistent-delay-in-reading-serial-data-in-python-3-7-2-using-pyserial
* https://projectgus.com/2011/10/notes-on-ftdi-latency-with-arduino/
## CAN Support
You may use the RPC Interface Library over CAN using [Kvaser](https://www.kvaser.com/) hardware on Windows and Linux (Kvaser does not support Mac). You need to install the following:
* For Windows
* [Kvaser Drivers for Windows](https://www.kvaser.com/download/?utm_source=software&utm_ean=7330130980013&utm_status=latest)
* [Kvaser CANlib SDK](https://www.kvaser.com/download/?utm_source=software&utm_ean=7330130980150&utm_status=latest)
* [Python module](https://www.kvaser.com/download/?utm_source=software&utm_ean=7330130981911&utm_status=latest)
* For Linux
* [Kvaser Linux Drivers and SDK](https://www.kvaser.com/download/?utm_source=software&utm_ean=7330130980754&utm_status=latest)
* [Python module](https://www.kvaser.com/download/?utm_source=software&utm_ean=7330130981911&utm_status=latest)
# How to use the Library
Please checkout the following scripts for how to control your OpenMV Cam from the computer:
* [Slow but Synchronous JPG Image Transfer](rpc_image_transfer_jpg_as_the_controller_device.py)
* [Fast JPG Image Streaming](rpc_image_transfer_jpg_streaming_as_the_controller_device.py)
* [Face Detection, April Tag Detection, Color Tracking, and more](rpc_popular_features_as_the_controller_device_example.py)
You will need to edit the example code above to choose which interface you want to use (USB versus Ethernet/WiFi) and to play with the settings the scripts use. When you run the scripts make sure to save them first after editing them and then run them with `python -u <script_name>` to make sure that script output to stdio is not buffered.
In general, for the controller device to use the `rpc` library you will create an interface object using the `rpc` library. For example:
interface = rpc.rpc_usb_vcp_master("COM3")
This create a USB VCP interface to talk to your OpenMV Cam over COM3. For Mac and Linux you would pass some type of `/dev/...` device instead.
Once the interface is created you just need to do:
memory_view_object_result = interface.call("remote_function_or_method_name", bytes_object_argument)
And the `rpc` library will try to execute that `"remote_function_or_method_name"` on your OpenMV Cam. The remote function or method will receive the `bytes_object_argument` which can be up to 2^32-1 bytes in size. Once the remote method finishes executing it will return a `memory_view_object_result` which can also be up to 2^32-1 bytes in size. Because the argument and response are both generic byte containers you can pass anything through the `rpc` library and receive any type of response. A simple way to pass arguments is to use `struct.pack()` to create the argument and `struct.unpack()` to receive the argument on the OpenMV Cam side. For the response, the OpenMV Cam may send a string object or json string as the result which the computer can then interpret. Most objects or lists returned from method calls on the OpenMV Cam generate valid json strings when you call `str()` on them.
As for errors, if you try to execute a non-existent function or method name on the OpenMV Cam the `call` method will return an empty `bytes()` object. If the `rpc` library failed to communicate with the OpenMV Cam the `rpc` library will return `None`.
To keep things simple the `rpc` library doesn't maintain a connection between the master and slave devices. The `call` method encapsulates trying to connect to the OpenMV Cam, starting execution of the remote function or method, and getting the result.
Now, on the OpenMV Cam side of things you have to create an `rpc` interface to communicate with the computer. This looks like:
interface = rpc.rpc_usb_vcp_slave()
This will create the interface layer on the OpenMV Cam (this needs to be done on a script running on the OpenMV Cam - see the [Remote Control](../../scripts/examples/34-Remote-Control) example scripts).
Once you create the slave interface you then need to register call backs that the master can call with the interface object.
def remote_function_or_method_name(memoryview_object_argument):
<lots of code>
return bytes_object_result
interface.register_callback(remote_function_or_method_name)
You may register as many callbacks as you like on the OpenMV Cam that the computer can call. Finally, once you are done registering callbacks you just need to execute:
interface.loop()
On the OpenMV Cam to start the `rpc` library up and begin listening for the computer. Note that the `loop()` method does not return. Also, to make your OpenMV Cam more robust against errors you may want to wrap the `loop()` with `try:` and `except:` for whatever exceptions might be thrown by your callback methods. The `rpc` library will not generate any exceptions itself. Note: passing large data structures around (like jpeg images) can potentially exhaust the heap on the OpenMV Cam and generate `MemoryError` exceptions.
And that is it! The `rpc` library is designed to be simple to use. It was designed to allow remote control of the OpenMV Cam by a computer or microcontroller so there are also interfaces for control of your OpenMV Cam over CAN, I2C, SPI, and UART.
# API
Please see the example scripts above for starting code on how to use the `rpc` library. The below API documents the public interface of the library.
## class rpc():
The `rpc` base class is reimplemented by the `rpc_master` and `rpc_slave` classes to create the master and slave interfaces. It is a pure virtual class and not meant to be used directly.
#### get_bytes(buff, timeout_ms):
This method is meant to be reimplemented by specific interface classes of `rpc_master` and `rpc_slave`. It should fill the `buff` argument which is either a `bytearray` or `memoryview` object of bytes from the interface equal to the length of the `buff` object in `timeout_ms` milliseconds. On timeout this method should return `None`. Note that for master and slave synchronization this method should try to always complete in at least `timeout_ms` milliseconds and not faster as the `rpc_master` and `rpc_slave` objects will automatically increase the `timeout_ms` to synchronize.
#### put_bytes(data, timeout_ms):
This method is meant to be reimplemented by specific interface classes of `rpc_master` and `rpc_slave`. It should send `data` bytes on the interface within `timeout_ms` milliseconds. If it completes faster than the timeout that is okay. No return value is expected.
#### stream_reader(call_back, queue_depth=1, read_timeout_ms=5000):
This method is meant to be called directly. After synchronization of the master and slave on return of a callback `stream_reader` may be called to receive data as fast as possible from the master or slave device. `call_back` will be called repeatedly with a `bytes_or_memory_view` argument that was sent by the `stream_writer`. `call_back` is not expected to return anything. `queue_depth` defines how many frames of data the `stream_writer` may generate before slowing down and waiting on the `stream_reader`. Higher `queue_depth` values lead to higher performance (up to a point) but require the `stream_reader` to be able to handle outstanding packets in its interface layer. Note that computers typically do not buffer much more than 4KB of data in device driver buffers. If you make the `queue_depth` larger than 1 then `call_back` should return very quickly and not block. Otherwise, you should implement a multi-thread architecture to process the received data so that `stream_reader` is always executing and moving data out of device driver buffers into larger user memory buffers. Finally, `read_timeout_ms` defines how many milliseconds to wait to receive the `bytes_or_memory_view` payload per `call_back`.
On any errors `stream_reader` will return. The master and slave devices can try to setup the stream again afterwards to continue as demonstrated in [Fast JPG Image Streaming](rpc_image_transfer_jpg_streaming_as_the_controller_device.py).
If you need to cancel the `stream_reader` just raise an exception in the `call_back` and catch it. The remote side will automatically timeout.
#### stream_writer(call_back, write_timeout_ms=5000):
This method is meant to be called directly. After synchronization of the master and slave on return of a callback `stream_writer` may be called to send data as fast as possible from the master or slave device. `call_back` will be called repeatedly and should return a `bytes_or_memory_view` object that will be sent to the `stream_reader`. `call_back` should not take any arguments. Finally, `write_timeout_ms` defines how many milliseconds to wait to send the `bytes_or_memory_view` object returned by `call_back`.
On any errors `stream_writer` will return. The master and slave devices can try to setup the stream again afterwards to continue as demonstrated in [Fast JPG Image Streaming](rpc_image_transfer_jpg_streaming_as_the_controller_device.py).
If you need to cancel the `stream_writer` just raise an exception in the `call_back` and catch it. The remote side will automatically timeout.
## class rpc_master():
The `rpc_master` is a pure virtual class and not meant to be used directly. Specific interface classes should reimplement `rpc_master`.
#### call(name, data=bytes(), send_timeout=1000, recv_timeout=1000):
Executes a remote call on the slave device. `name` is a string name of the remote function or method to execute. `data` is the `bytes` like object that will be sent as the argument of the remote function or method to execute. `send_timeout` defines how many milliseconds to wait while trying to connect to the slave and get it to execute the remote function or method. Once the master starts sending the argument to the slave device `send_timeout` does not apply. The library will allow the argument to take up to 5 seconds to be sent. `recv_timeout` defines how many milliseconds to wait after the slave started executing the remote method to receive the response. Note that once the master starts receiving the response `recv_timeout` does not apply. The library will allow the response to take up to 5 seconds to be received.
Note that a new packet that includes a copy of `data` will be created internally inside the `rpc` library. You may encounter memory issues on the OpenMV Cam if you try to pass very large data arguments.
## class rpc_slave():
The `rpc_slave` is a pure virtual class and not meant to be used directly. Specific interface classes should reimplement `rpc_slave`.
#### register_callback(cb):
Registers a call back that can be executed by the master device. The call back should take one argument which will be a `memoryview` object and it should return a `bytes()` like object as the result. The call back should return in less than 1 second if possible.
#### schedule_callback(cb):
After you execute `loop()` it is not possible to execute long running operations outside of the `rpc` library. `schedule_callback` allows you to break out of the `rpc` library temporarily after completion of an call back. You should execute `schedule_callback` during the execution of an `rpc` call back method to register a new non-rpc call back that will be executed immediately after the successful completion of that call back you executed `schedule_callback` in. The function or method should not take any arguments. After the the call back that was registered returns it must be registered again in the next parent call back. On any error of the parent call back the registered call back will not be called and must be registered again. Here's how to use this:
def some_function_or_method_that_takes_a_long_time_to_execute():
<do stuff>
def normal_rpc_call_back(data):
<process data>
interface.schedule_callback(some_function_or_method_that_takes_a_long_time_to_execute)
return bytes(response)
interface.register_callback(normal_rpc_call_back)
interface.loop()
`schedule_callback` in particular allows you to use the `get_bytes` and `put_bytes` methods for cut-through data transfer between one device and another without the cost of packetization which limits the size of the data moved inside the `rpc` library without running out of memory on the OpenMV Cam.
#### setup_loop_callback(cb):
The loop call back is called every loop iteration of `loop()`. Unlike the `schedule_callback()` call back this call back stays registered after being registered once. You can use the loop call back to blink an activity LED or something like that. You should not use the loop call back to execute any blocking code as this will get in the way of polling for communication from the master. Additionally, the loop call back will be called at a variable rate depending on when and what call backs the master is trying to execute. Given this, the loop call back is not suitable for any method that needs to be executed at a fixed frequency.
On the OpenMV Cam, if you need to execute something at a fixed frequency, you should setup a timer before executing `loop()` and use a timer interrupt based callback to execute some function or method at a fixed frequency. Please see how to [Write Interrupt Handlers](http://docs.openmv.io/reference/isr_rules.html) for more information. Note: The `mutex` library is installed on your OpenMV Cam along with the `rpc` library.
#### loop(recv_timeout=1000, send_timeout=1000):
Starts execution of the `rpc` library on the slave to receive data. This method does not return (except via an exception from a call back). You should register all call backs first before executing this method. However, it is possible to register new call backs inside of a call back previously being registered that is executing.
`recv_timeout` defines how long to wait to receive a command from the master device before trying again. `send_timeout` defines how long the slave will wait for the master to receive the call back response before going back to trying to receive. The loop call back will be executed before trying to receive again.
## rpc_uart_master(port, baudrate=9600)
Creates a master implementation of the `rpc` library to communicate over a hardware RS232/RS422/RS485 or TTL COM port. `port` is the string name of the serial port. `baudrate` is the bits per second to run at.
Please use the `rpc_usb_vcp_master` to talk to the OpenMV Cam over its USB interface. This class is for talking to the OpenMV Cam over its hardware UART.
If you are using this class with USB to serial converters you will likely experience intermittent synchronization issues. The RPC library uart interface on the OpenMV Cam is designed to work with real-time UARTs like hardware RS232/RS422/RS485 COM ports on PCs and TTL UARTS on single board computers like the RaspberryPi and Beaglebone. That said, the interface library can handle this and will continue to work.
## rpc_uart_slave(port, baudrate=9600)
Creates a slave implementation of the `rpc` library to communicate over a hardware RS232/RS422/RS485 or TTL COM port. `port` is the string name of the serial port. `baudrate` is the bits per second to run at.
Please use the `rpc_usb_vcp_slave` to talk to the OpenMV Cam over its USB interface. This class is for talking to the OpenMV Cam over its hardware UART.
If you are using this class with USB to serial converters you will likely experience intermittent synchronization issues. The RPC library uart interface on the OpenMV Cam is designed to work with real-time UARTs like hardware RS232/RS422/RS485 COM ports on PCs and TTL UARTS on single board computers like the RaspberryPi and Beaglebone. That said, the interface library can handle this and will continue to work.
## rpc_usb_vcp_master(port):
Creates a master implementation of the `rpc` library to communicate over a USB VCP (virtual COM port). `port` is the string name of the serial port.
Communication over USB is the most reliable and high speed way to connect an OpenMV Cam to a computer. However, as the OpenMV Cam has only one VCP port we recommend that you fully debug your script using the `rpc_usb_vcp_slave` on your OpenMV using another `rpc` interface if possible as you will not be able to get error messages off the OpenMV Cam easily. For example, connecting the `rpc_usb_vcp_master` to the `rpc_uart_slave` on your OpenMV Cam at 115200 BPS over a USB-to-Serial adapter when debugging will make your life far easier. Alternatively, use the Ethernet or WiFi interface when debugging.
## rpc_usb_vcp_slave(port):
Creates a slave implementation of the `rpc` library to communicate over a USB VCP (virtual COM port). `port` is the string name of the serial port.
Communication over USB is the most reliable and high speed way to connect an OpenMV Cam to a computer. However, as the OpenMV Cam has only one VCP port we recommend that you fully debug your script using the `rpc_usb_vcp_master` on your OpenMV using another `rpc` interface if possible as you will not be able to get error messages off the OpenMV Cam easily. For example, connecting the `rpc_usb_vcp_slave` to the `rpc_uart_master` on your OpenMV Cam at 115200 BPS over a USB-to-Serial adapter when debugging will make your life far easier. Alternatively, use the Ethernet or WiFi interface when debugging.
## rpc_network_master(slave_ip, my_ip="", port=0x1DBA):
Creates a master implementation of the `rpc` library to communicate over WiFi or Ethernet. `slave_ip` is the IPV4 address of the `rpc` slave device. `my_ip` can be `""` which binds the master to any interface adapter to communicate to the slave. If `my_ip` is not `""` then it should be an IP address on the same subnet as `slave_ip`. `port` is a free port to use for UDP and TCP traffic.
## rpc_network_slave(my_ip="", port=0x1DBA):
Creates a slave implementation of the `rpc` library to communicate over WiFi or Ethernet. `my_ip` can be `""` which binds the slave to any interface adapter to communicate to the master. If `my_ip` is not `""` then it should be an IP address on the same subnet as the master. `port` is a free port to use for UDP and TCP traffic.
## rpc_kvarser_can_master(channel, message_id=0x7FF, bit_rate=250000, sampling_point=75)
Creates a master implementation of the `rpc` library to communicate over CAN using Kvarser hardware. `channel` is the Kvarser channel to use. `message_id` is the 11-bit CAN ID to use for data transport. `bit_rate` is the CAN bus rate. `sampling_point` is the percentage sample point on the CAN bus.
## rpc_kvarser_can_slave(channel, message_id=0x7FF, bit_rate=250000, sampling_point=75)
Creates a slave implementation of the `rpc` library to communicate over CAN using Kvarser hardware. `channel` is the Kvarser channel to use. `message_id` is the 11-bit CAN ID to use for data transport. `bit_rate` is the CAN bus rate. `sampling_point` is the percentage sample point on the CAN bus.

View File

@ -1,810 +0,0 @@
# This file is part of the OpenMV project.
#
# Copyright (c) 2013-2020 Ibrahim Abdelkader <iabdalkader@openmv.io>
# Copyright (c) 2013-2020 Kwabena W. Agyeman <kwagyeman@openmv.io>
#
# This work is licensed under the MIT license, see the file LICENSE for details.
import gc, serial, socket, struct, time
class rpc:
_COMMAND_HEADER_PACKET_MAGIC = 0x1209
_COMMAND_DATA_PACKET_MAGIC = 0xABD1
_RESULT_HEADER_PACKET_MAGIC = 0x9021
_RESULT_DATA_PACKET_MAGIC = 0x1DBA
def __def_crc_16(self, data, size): # private
crc = 0xFFFF
for i in range(size):
crc ^= data[i] << 8
for j in range(8): crc = (crc << 1) ^ (0x1021 if crc & 0x8000 else 0)
return crc & 0xFFFF
__crc_16_table = [0x0000, 0x1021, 0x2042, 0x3063, 0x4084, 0x50A5, 0x60C6, 0x70E7,
0x8108, 0x9129, 0xA14A, 0xB16B, 0xC18C, 0xD1AD, 0xE1CE, 0xF1EF,
0x1231, 0x0210, 0x3273, 0x2252, 0x52B5, 0x4294, 0x72F7, 0x62D6,
0x9339, 0x8318, 0xB37B, 0xA35A, 0xD3BD, 0xC39C, 0xF3FF, 0xE3DE,
0x2462, 0x3443, 0x0420, 0x1401, 0x64E6, 0x74C7, 0x44A4, 0x5485,
0xA56A, 0xB54B, 0x8528, 0x9509, 0xE5EE, 0xF5CF, 0xC5AC, 0xD58D,
0x3653, 0x2672, 0x1611, 0x0630, 0x76D7, 0x66F6, 0x5695, 0x46B4,
0xB75B, 0xA77A, 0x9719, 0x8738, 0xF7DF, 0xE7FE, 0xD79D, 0xC7BC,
0x48C4, 0x58E5, 0x6886, 0x78A7, 0x0840, 0x1861, 0x2802, 0x3823,
0xC9CC, 0xD9ED, 0xE98E, 0xF9AF, 0x8948, 0x9969, 0xA90A, 0xB92B,
0x5AF5, 0x4AD4, 0x7AB7, 0x6A96, 0x1A71, 0x0A50, 0x3A33, 0x2A12,
0xDBFD, 0xCBDC, 0xFBBF, 0xEB9E, 0x9B79, 0x8B58, 0xBB3B, 0xAB1A,
0x6CA6, 0x7C87, 0x4CE4, 0x5CC5, 0x2C22, 0x3C03, 0x0C60, 0x1C41,
0xEDAE, 0xFD8F, 0xCDEC, 0xDDCD, 0xAD2A, 0xBD0B, 0x8D68, 0x9D49,
0x7E97, 0x6EB6, 0x5ED5, 0x4EF4, 0x3E13, 0x2E32, 0x1E51, 0x0E70,
0xFF9F, 0xEFBE, 0xDFDD, 0xCFFC, 0xBF1B, 0xAF3A, 0x9F59, 0x8F78,
0x9188, 0x81A9, 0xB1CA, 0xA1EB, 0xD10C, 0xC12D, 0xF14E, 0xE16F,
0x1080, 0x00A1, 0x30C2, 0x20E3, 0x5004, 0x4025, 0x7046, 0x6067,
0x83B9, 0x9398, 0xA3FB, 0xB3DA, 0xC33D, 0xD31C, 0xE37F, 0xF35E,
0x02B1, 0x1290, 0x22F3, 0x32D2, 0x4235, 0x5214, 0x6277, 0x7256,
0xB5EA, 0xA5CB, 0x95A8, 0x8589, 0xF56E, 0xE54F, 0xD52C, 0xC50D,
0x34E2, 0x24C3, 0x14A0, 0x0481, 0x7466, 0x6447, 0x5424, 0x4405,
0xA7DB, 0xB7FA, 0x8799, 0x97B8, 0xE75F, 0xF77E, 0xC71D, 0xD73C,
0x26D3, 0x36F2, 0x0691, 0x16B0, 0x6657, 0x7676, 0x4615, 0x5634,
0xD94C, 0xC96D, 0xF90E, 0xE92F, 0x99C8, 0x89E9, 0xB98A, 0xA9AB,
0x5844, 0x4865, 0x7806, 0x6827, 0x18C0, 0x08E1, 0x3882, 0x28A3,
0xCB7D, 0xDB5C, 0xEB3F, 0xFB1E, 0x8BF9, 0x9BD8, 0xABBB, 0xBB9A,
0x4A75, 0x5A54, 0x6A37, 0x7A16, 0x0AF1, 0x1AD0, 0x2AB3, 0x3A92,
0xFD2E, 0xED0F, 0xDD6C, 0xCD4D, 0xBDAA, 0xAD8B, 0x9DE8, 0x8DC9,
0x7C26, 0x6C07, 0x5C64, 0x4C45, 0x3CA2, 0x2C83, 0x1CE0, 0x0CC1,
0xEF1F, 0xFF3E, 0xCF5D, 0xDF7C, 0xAF9B, 0xBFBA, 0x8FD9, 0x9FF8,
0x6E17, 0x7E36, 0x4E55, 0x5E74, 0x2E93, 0x3EB2, 0x0ED1, 0x1EF0]
def __tab_crc_16(self, data, size): # private
crc = 0xFFFF
for i in range(size): crc = self.__crc_16_table[((crc >> 8) ^ data[i]) & 0xff] ^ (crc << 8)
return crc & 0xFFFF
def _zero(self, buff, size): # private
for i in range(size): buff[i] = 0
def _same(self, data, size): # private
if not size: return False
old = data[0]
for i in range(1, size):
new = data[i]
if new != old: return False
old = new
return True
# djb2 algorithm; see http://www.cse.yorku.ca/~oz/hash.html
def _hash(self, data, size): # private
h = 5381
for i in range(size):
h = ((h << 5) + h) ^ ord(data[i])
return h & 0xFFFFFFFF
def __init__(self): # private
self.__crc_16 = self.__tab_crc_16
self._stream_writer_queue_depth_max = 255
def _get_packet_pre_alloc(self, payload_len=0):
buff = bytearray(payload_len + 4)
return (buff, memoryview(buff)[2:-2])
def _get_packet(self, magic_value, payload_buf_tuple, timeout): # private
packet = self.get_bytes(payload_buf_tuple[0], timeout)
if packet is not None:
magic = packet[0] | (packet[1] << 8)
crc = packet[-2] | (packet[-1] << 8)
if magic == magic_value and crc == self.__crc_16(packet, len(packet) - 2):
return payload_buf_tuple[1]
return None
def _set_packet(self, magic_value, payload=bytes()): # private
new_payload = bytearray(len(payload) + 4)
new_payload[:2] = struct.pack("<H", magic_value)
# Fix Python 3.x.
try: new_payload[2:-2] = payload
except TypeError: new_payload[2:-2] = payload.encode()
new_payload[-2:] = struct.pack("<H", self.__crc_16(new_payload, len(payload) + 2))
return new_payload
def _flush(self): # protected
pass
def get_bytes(self, buff, timeout_ms): # protected
return bytes()
def put_bytes(self, data, timeout_ms): # protected
pass
def stream_reader(self, call_back, queue_depth=1, read_timeout_ms=5000): # public
try: self._stream_put_bytes(self._set_packet(0xEDF6, struct.pack("<I", queue_depth)), 1000)
except OSError: return
tx_lfsr = 255
while True:
packet = self._stream_get_bytes(bytearray(8), 1000)
if packet is None: return
magic = packet[0] | (packet[1] << 8)
crc = packet[-2] | (packet[-1] << 8)
if magic != 0x542E and crc != self.__crc_16(packet, len(packet) - 2): return
data = self._stream_get_bytes(bytearray(struct.unpack("<I", packet[2:-2])[0]), read_timeout_ms)
if data is None: return
call_back(data)
try: self._stream_put_bytes(struct.pack("<B", tx_lfsr), 1000)
except OSError: return
tx_lfsr = (tx_lfsr >> 1) ^ (0xB8 if tx_lfsr & 1 else 0x00)
def stream_writer(self, call_back, write_timeout_ms=5000): # public
packet = self._stream_get_bytes(bytearray(8), 1000)
if packet is None: return
magic = packet[0] | (packet[1] << 8)
crc = packet[-2] | (packet[-1] << 8)
if magic != 0xEDF6 and crc != self.__crc_16(packet, len(packet) - 2): return
queue_depth = max(min(struct.unpack("<I", packet[2:-2])[0], self._stream_writer_queue_depth_max), 1)
rx_lfsr = 255
credits = queue_depth
while True:
if credits <= (queue_depth // 2):
data = self._stream_get_bytes(bytearray(1), 1000)
if data is None or data[0] != rx_lfsr: return
rx_lfsr = (rx_lfsr >> 1) ^ (0xB8 if rx_lfsr & 1 else 0x00)
credits += 1
if credits > 0:
data = call_back()
try: self._stream_put_bytes(self._set_packet(0x542E, struct.pack("<I", len(data))), 1000)
except OSError: return
try: self._stream_put_bytes(data, write_timeout_ms)
except OSError: return
credits -= 1
def _stream_get_bytes(self, buff, timeout_ms): # protected
return self.get_bytes(buff, timeout_ms)
def _stream_put_bytes(self, data, timeout_ms): # protected
self.put_bytes(data, timeout_ms)
class rpc_master(rpc):
def __init__(self): # private
rpc.__init__(self)
self.__in_command_header_buf = self._get_packet_pre_alloc()
self.__in_command_data_buf = self._get_packet_pre_alloc()
self.__out_result_header_ack = self._set_packet(self._RESULT_HEADER_PACKET_MAGIC)
self.__in_result_header_buf = self._get_packet_pre_alloc(4)
self.__out_result_data_ack = self._set_packet(self._RESULT_DATA_PACKET_MAGIC)
self._put_short_timeout_reset = 3
self._get_short_timeout_reset = 3
self._put_long_timeout = 5000
self._get_long_timeout = 5000
def __put_command(self, command, data, timeout): # private
self._put_short_timeout = self._put_short_timeout_reset
self._get_short_timeout = self._get_short_timeout_reset
out_header = self._set_packet(self._COMMAND_HEADER_PACKET_MAGIC, struct.pack("<II", command, len(data)))
out_data = self._set_packet(self._COMMAND_DATA_PACKET_MAGIC, data)
start = int(time.time() * 1000)
while (int(time.time() * 1000) - start) < timeout:
gc.collect() # Avoid collection during the transfer.
self._zero(self.__in_command_header_buf[0], len(self.__in_command_header_buf[0]))
self._zero(self.__in_command_data_buf[0], len(self.__in_command_data_buf[0]))
self._flush()
self.put_bytes(out_header, self._put_short_timeout)
if self._get_packet(self._COMMAND_HEADER_PACKET_MAGIC, self.__in_command_header_buf, self._get_short_timeout) is not None:
self.put_bytes(out_data, self._put_long_timeout)
if self._get_packet(self._COMMAND_DATA_PACKET_MAGIC, self.__in_command_data_buf, self._get_short_timeout) is not None:
return True
# Avoid timeout livelocking.
self._put_short_timeout = min((self._put_short_timeout * 4) // 3, timeout)
self._get_short_timeout = min((self._get_short_timeout * 4) // 3, timeout)
return False
def __get_result(self, timeout): # private
self._put_short_timeout = self._put_short_timeout_reset
self._get_short_timeout = self._get_short_timeout_reset
start = int(time.time() * 1000)
while (int(time.time() * 1000) - start) < timeout:
gc.collect() # Avoid collection during the transfer.
self._zero(self.__in_result_header_buf[0], len(self.__in_result_header_buf[0]))
self._flush()
self.put_bytes(self.__out_result_header_ack, self._put_short_timeout)
packet = self._get_packet(self._RESULT_HEADER_PACKET_MAGIC, self.__in_result_header_buf, self._get_short_timeout)
if packet is not None:
in_result_data_buf = self._get_packet_pre_alloc(struct.unpack("<I", packet)[0])
self.put_bytes(self.__out_result_data_ack, self._put_short_timeout)
dat_packet = self._get_packet(self._RESULT_DATA_PACKET_MAGIC, in_result_data_buf, self._get_long_timeout)
if dat_packet is not None:
return dat_packet
# Avoid timeout livelocking.
self._put_short_timeout = min((self._put_short_timeout * 4) // 3, timeout)
self._get_short_timeout = min((self._get_short_timeout * 4) // 3, timeout)
return None
def call(self, name, data=bytes(), send_timeout=1000, recv_timeout=1000): # public
return self.__get_result(recv_timeout) if self.__put_command(self._hash(name, len(name)), data, send_timeout) else None
class rpc_slave(rpc):
def __init__(self): # private
self.__dict = {}
self.__schedule_cb = None
self.__loop_cb = None
rpc.__init__(self)
self.__in_command_header_buf = self._get_packet_pre_alloc(8)
self.__out_command_header_ack = self._set_packet(self._COMMAND_HEADER_PACKET_MAGIC)
self.__out_command_data_ack = self._set_packet(self._COMMAND_DATA_PACKET_MAGIC)
self.__in_response_header_buf = self._get_packet_pre_alloc()
self.__in_response_data_buf = self._get_packet_pre_alloc()
self._put_short_timeout_reset = 2
self._get_short_timeout_reset = 2
self._put_long_timeout = 5000
self._get_long_timeout = 5000
def __get_command(self, timeout): # private
self._put_short_timeout = self._put_short_timeout_reset
self._get_short_timeout = self._get_short_timeout_reset
start = int(time.time() * 1000)
while (int(time.time() * 1000) - start) < timeout:
gc.collect() # Avoid collection during the transfer.
self._zero(self.__in_command_header_buf[0], len(self.__in_command_header_buf[0]))
self._flush()
packet = self._get_packet(self._COMMAND_HEADER_PACKET_MAGIC, self.__in_command_header_buf, self._get_short_timeout)
if packet is not None:
command, datalen = struct.unpack("<II", packet)
in_command_data_buf = self._get_packet_pre_alloc(datalen)
self.put_bytes(self.__out_command_header_ack, self._put_short_timeout)
dat_packet = self._get_packet(self._COMMAND_DATA_PACKET_MAGIC, in_command_data_buf, self._get_long_timeout)
if dat_packet is not None:
self.put_bytes(self.__out_command_data_ack, self._put_short_timeout)
return (command, dat_packet)
# Avoid timeout livelocking.
self._put_short_timeout = min(self._put_short_timeout + 1, timeout)
self._get_short_timeout = min(self._get_short_timeout + 1, timeout)
return (None, None)
def __put_result(self, data, timeout): # private
self._put_short_timeout = self._put_short_timeout_reset
self._get_short_timeout = self._get_short_timeout_reset
out_header = self._set_packet(self._RESULT_HEADER_PACKET_MAGIC, struct.pack("<I", len(data)))
out_data = self._set_packet(self._RESULT_DATA_PACKET_MAGIC, data)
start = int(time.time() * 1000)
while (int(time.time() * 1000) - start) < timeout:
gc.collect() # Avoid collection during the transfer.
self._zero(self.__in_response_header_buf[0], len(self.__in_response_header_buf[0]))
self._zero(self.__in_response_data_buf[0], len(self.__in_response_data_buf[0]))
self._flush()
if self._get_packet(self._RESULT_HEADER_PACKET_MAGIC, self.__in_response_header_buf, self._get_short_timeout) is not None:
self.put_bytes(out_header, self._put_short_timeout)
if self._get_packet(self._RESULT_DATA_PACKET_MAGIC, self.__in_response_data_buf, self._get_short_timeout) is not None:
self.put_bytes(out_data, self._put_long_timeout)
return True
# Avoid timeout livelocking.
self._put_short_timeout = min(self._put_short_timeout + 1, timeout)
self._get_short_timeout = min(self._get_short_timeout + 1, timeout)
return False
def register_callback(self, cb): # public
self.__dict[self._hash(cb.__name__, len(cb.__name__))] = cb
def schedule_callback(self, cb): # public
self.__schedule_cb = cb
def setup_loop_callback(self, cb): # public
self.__loop_cb = cb
def loop(self, recv_timeout=1000, send_timeout=1000): # public
while True:
command, data = self.__get_command(recv_timeout)
if command is not None:
cb = self.__dict.get(command)
if self.__put_result(cb(data) if cb is not None else bytes(), send_timeout) and self.__schedule_cb is not None:
self.__schedule_cb()
self.__schedule_cb = None
if self.__loop_cb is not None: self.__loop_cb()
class rpc_uart_master(rpc_master):
# We need to do reads this way so that we get a short timeout while waiting for data and then
# no timeout while data is coming in. pyserial inter_byte_timeout does not work.
def __get_bytes(self, buff):
i = 0
l = len(buff)
while l:
data = self.__ser.read(min(l, 1024)) # Starts a new timeout per call.
data_len = len(data)
if not data_len: return None
buff[i:i+data_len] = data
i += data_len
l -= data_len
return buff
def __init__(self, port, baudrate=9600): # private
self.__ser = serial.Serial(port, baudrate=baudrate, timeout=0.01)
rpc_master.__init__(self)
def _flush(self): # protected
self.__ser.reset_input_buffer()
def get_bytes(self, buff, timeout_ms): # protected
if int(self.__ser.timeout * 100) != 1: self.__ser.timeout = 0.01 # Changing this causes control transfers.
result = self.__get_bytes(buff)
if result is None: time.sleep(self._get_short_timeout * 0.001)
return result
def put_bytes(self, data, timeout_ms): # protected
self.__ser.write(data)
def _stream_get_bytes(self, buff, timeout_ms): # protected
if int(self.__ser.timeout) != 1: self.__ser.timeout = 1 # Changing this causes control transfers.
return self.__get_bytes(buff)
class rpc_uart_slave(rpc_slave):
# We need to do reads this way so that we get a short timeout while waiting for data and then
# no timeout while data is coming in. pyserial inter_byte_timeout does not work.
def __get_bytes(self, buff):
i = 0
l = len(buff)
while l:
data = self.__ser.read(min(l, 1024)) # Starts a new timeout per call.
data_len = len(data)
if not data_len: return None
buff[i:i+data_len] = data
i += data_len
l -= data_len
return buff
def __init__(self, port, baudrate=9600): # private
self.__ser = serial.Serial(port, baudrate=baudrate, timeout=0.01)
rpc_slave.__init__(self)
def _flush(self): # protected
self.__ser.reset_input_buffer()
def get_bytes(self, buff, timeout_ms): # protected
if int(self.__ser.timeout * 100) != 1: self.__ser.timeout = 0.01 # Changing this causes control transfers.
return self.__get_bytes(buff)
def put_bytes(self, data, timeout_ms): # protected
self.__ser.write(data)
def _stream_get_bytes(self, buff, timeout_ms): # protected
if int(self.__ser.timeout) != 1: self.__ser.timeout = 1 # Changing this causes control transfers.
return self.__get_bytes(buff)
class rpc_usb_vcp_master(rpc_master):
# We need to do reads this way so that we get a short timeout while waiting for data and then
# no timeout while data is coming in. pyserial inter_byte_timeout does not work.
def __get_bytes(self, buff):
i = 0
l = len(buff)
while l:
data = self.__ser.read(min(l, 1024)) # Starts a new timeout per call.
data_len = len(data)
if not data_len: return None
buff[i:i+data_len] = data
i += data_len
l -= data_len
return buff
def __init__(self, port): # private
self.__ser = serial.Serial(port, baudrate=115200, timeout=0.01)
rpc_master.__init__(self)
def _flush(self): # protected
self.__ser.reset_input_buffer()
def get_bytes(self, buff, timeout_ms): # protected
if int(self.__ser.timeout * 100) != 1: self.__ser.timeout = 0.01 # Changing this causes control transfers.
result = self.__get_bytes(buff)
if result is None: time.sleep(timeout_ms * 0.001)
return result
def put_bytes(self, data, timeout_ms): # protected
self.__ser.write(data)
def _stream_get_bytes(self, buff, timeout_ms): # protected
if int(self.__ser.timeout) != 1: self.__ser.timeout = 1 # Changing this causes control transfers.
return self.__get_bytes(buff)
class rpc_usb_vcp_slave(rpc_slave):
# We need to do reads this way so that we get a short timeout while waiting for data and then
# no timeout while data is coming in. pyserial inter_byte_timeout does not work.
def __get_bytes(self, buff):
i = 0
l = len(buff)
while l:
data = self.__ser.read(min(l, 1024)) # Starts a new timeout per call.
data_len = len(data)
if not data_len: return None
buff[i:i+data_len] = data
i += data_len
l -= data_len
return buff
def __init__(self, port): # private
self.__ser = serial.Serial(port, baudrate=115200, timeout=0.01)
rpc_slave.__init__(self)
def _flush(self): # protected
self.__ser.reset_input_buffer()
def get_bytes(self, buff, timeout_ms): # protected
if int(self.__ser.timeout * 100) != 1: self.__ser.timeout = 0.01 # Changing this causes control transfers.
return self.__get_bytes(buff)
def put_bytes(self, data, timeout_ms): # protected
self.__ser.write(data)
def _stream_get_bytes(self, buff, timeout_ms): # protected
if int(self.__ser.timeout) != 1: self.__ser.timeout = 1 # Changing this causes control transfers.
return self.__get_bytes(buff)
class rpc_network_master(rpc_master):
def __valid_tcp_socket(self): # private
if self.__tcp__socket is None:
try:
s = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
s.bind(self.__myaddr)
s.listen(0)
s.settimeout(1)
self.__tcp__socket, addr = s.accept()
s.close()
except (socket.timeout, socket.error): self.__tcp__socket = None
return self.__tcp__socket is not None
def __close_tcp_socket(self): # private
self.__tcp__socket.close()
self.__tcp__socket = None
def __valid_udp_socket(self): # private
if self.__udp__socket is None:
try:
self.__udp__socket = socket.socket(socket.AF_INET, socket.SOCK_DGRAM)
self.__udp__socket.bind(self.__myaddr)
except (socket.timeout, socket.error): self.__udp__socket = None
return self.__udp__socket is not None
def __close_udp_socket(self): # private
self.__udp__socket.close()
self.__udp__socket = None
def __init__(self, slave_ip, my_ip="", port=0x1DBA): # private
self._udp_limit = 1400
self._timeout_scale = 10
self.__myip = my_ip
self.__myaddr = (self.__myip, port)
self.__slave_addr = (slave_ip, port)
self.__tcp__socket = None
self.__udp__socket = None
print("IP Address:Port %s:%d\nRunning..." % self.__myaddr)
rpc_master.__init__(self)
def _flush(self): # protected
if self.__valid_udp_socket():
try:
self.__udp__socket.settimeout(0.001)
while(True):
data, addr = self.__udp__socket.recvfrom(1400)
if not len(data): break
except socket.timeout: pass
except socket.error as err: self.__close_udp_socket()
if self.__tcp__socket is not None:
try:
self.__tcp__socket.settimeout(0.001)
while(True):
data = self.__tcp__socket.recvfrom(1400)
if not len(data): break
except socket.timeout: pass
except socket.error as err: self.__close_tcp_socket()
def get_bytes(self, buff, timeout_ms): # protected
i = 0
l = len(buff)
if l <= self._udp_limit:
if self.__valid_udp_socket():
try:
self.__udp__socket.settimeout(self._get_short_timeout * 0.001 * self._timeout_scale)
while l:
data, addr = self.__udp__socket.recvfrom(min(l, 1400))
data_len = len(data)
if not data_len: break
buff[i:i+data_len] = data
i += data_len
l -= data_len
# We don't need to close the socket on error since it's connectionless.
except socket.timeout: pass
except socket.error: self.__close_udp_socket()
elif self.__valid_tcp_socket():
try:
self.__tcp__socket.settimeout(100)
while l:
data = self.__tcp__socket.recv(min(l, 1400))
data_len = len(data)
if not data_len: break
buff[i:i+data_len] = data
i += data_len
l -= data_len
if l: self.__close_tcp_socket()
except (socket.timeout, socket.error): self.__close_tcp_socket()
return buff if not l else None
def put_bytes(self, data, timeout_ms): # protected
i = 0
l = len(data)
if l <= self._udp_limit:
if self.__valid_udp_socket():
try:
self.__udp__socket.settimeout(self._put_short_timeout * 0.001 * self._timeout_scale)
while l:
data_len = self.__udp__socket.sendto(data[i:i+min(l, 1400)], self.__slave_addr)
if not data_len: break
i += data_len
l -= data_len
if l: self.__close_udp_socket()
except (socket.timeout, socket.error): self.__close_udp_socket()
elif self.__valid_tcp_socket():
try:
self.__tcp__socket.settimeout(100)
while l:
data_len = self.__tcp_socket.send(data[i:i+min(l, 1400)])
if not data_len: break
i += data_len
l -= data_len
if l: self.__close_tcp_socket()
except (socket.timeout, socket.error): self.__close_tcp_socket()
def _stream_get_bytes(self, buff, timeout_ms): # protected
i = 0
l = len(buff)
if self.__valid_tcp_socket():
try:
self.__tcp__socket.settimeout(timeout_ms * 0.001)
while l:
data = self.__tcp__socket.recv(min(l, 1400))
data_len = len(data)
if not data_len: break
buff[i:i+data_len] = data
i += data_len
l -= data_len
if l: self.__close_tcp_socket()
except (socket.timeout, socket.error): self.__close_tcp_socket()
return buff if not l else None
def _stream_put_bytes(self, data, timeout_ms): # protected
i = 0
l = len(data)
if self.__valid_tcp_socket():
try:
self.__tcp__socket.settimeout(timeout_ms * 0.001)
while l:
data_len = self.__tcp__socket.send(data[i:i+min(l, 1400)])
if not data_len: break
i += data_len
l -= data_len
if l: self.__close_tcp_socket()
except (socket.timeout, socket.error): self.__close_tcp_socket()
if l: raise OSError # Stop Stream.
class rpc_network_slave(rpc_slave):
def __valid_tcp_socket(self): # private
if self.__tcp__socket is None:
try:
self.__tcp__socket = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
self.__tcp__socket.connect(self.__master_addr)
except (socket.timeout, socket.error): self.__tcp__socket = None
return self.__tcp__socket is not None
def __close_tcp_socket(self): # private
self.__tcp__socket.close()
self.__tcp__socket = None
def __valid_udp_socket(self): # private
if self.__udp__socket is None:
try:
self.__udp__socket = socket.socket(socket.AF_INET, socket.SOCK_DGRAM)
self.__udp__socket.bind(self.__myaddr)
except (socket.timeout, socket.error): self.__udp__socket = None
return self.__udp__socket is not None
def __close_udp_socket(self): # private
self.__udp__socket.close()
self.__udp__socket = None
def __init__(self, my_ip="", port=0x1DBA): # private
self._udp_limit = 1400
self._timeout_scale = 10
self.__myip = my_ip
self.__myaddr = (self.__myip, port)
self.__master_addr = None
self.__tcp__socket = None
self.__udp__socket = None
print("IP Address:Port %s:%d\nRunning..." % self.__myaddr)
rpc_slave.__init__(self)
def _flush(self): # protected
if self.__valid_udp_socket():
try:
self.__udp__socket.settimeout(0.001)
while(True):
data, addr = self.__udp__socket.recvfrom(1400)
if not len(data): break
except socket.timeout: pass
except socket.error: self.__close_udp_socket()
if self.__tcp__socket is not None:
try:
self.__tcp__socket.settimeout(0.001)
while(True):
data = self.__tcp__socket.recvfrom(1400)
if not len(data): break
except socket.timeout: pass
except socket.error: self.__close_tcp_socket()
def get_bytes(self, buff, timeout_ms): # protected
i = 0
l = len(buff)
if l <= self._udp_limit:
if self.__valid_udp_socket():
try:
self.__udp__socket.settimeout(self._get_short_timeout * 0.001 * self._timeout_scale)
while l:
data, addr = self.__udp__socket.recvfrom(min(l, 1400))
data_len = len(data)
if not data_len: break
buff[i:i+data_len] = data
self.__master_addr = addr
i += data_len
l -= data_len
# We don't need to close the socket on error since it's connectionless.
except socket.timeout: pass
except socket.error: self.__close_udp_socket()
elif self.__valid_tcp_socket():
try:
self.__tcp__socket.settimeout(100)
while l:
data = self.__tcp__socket.recv(min(l, 1400))
data_len = len(data)
if not data_len: break
buff[i:i+data_len] = data
i += data_len
l -= data_len
if l: self.__close_tcp_socket()
except (socket.timeout, socket.error): self.__close_tcp_socket()
return buff if not l else None
def put_bytes(self, data, timeout_ms): # protected
i = 0
l = len(data)
if l <= self._udp_limit:
if self.__valid_udp_socket():
try:
self.__udp__socket.settimeout(self._put_short_timeout * 0.001 * self._timeout_scale)
while l:
data_len = self.__udp__socket.sendto(data[i:i+min(l, 1400)], self.__master_addr)
if not data_len: break
i += data_len
l -= data_len
if l: self.__close_udp_socket()
except (socket.timeout, socket.error): self.__close_udp_socket()
elif self.__valid_tcp_socket():
try:
self.__tcp__socket.settimeout(100)
while l:
data_len = self.__tcp__socket.send(data[i:i+min(l, 1400)])
if not data_len: break
i += data_len
l -= data_len
if l: self.__close_tcp_socket()
except (socket.timeout, socket.error): self.__close_tcp_socket()
def _stream_get_bytes(self, buff, timeout_ms): # protected
i = 0
l = len(buff)
if self.__valid_tcp_socket():
try:
self.__tcp__socket.settimeout(timeout_ms * 0.001)
while l:
data = self.__tcp__socket.recv(min(l, 1400))
data_len = len(data)
if not data_len: break
buff[i:i+data_len] = data
i += data_len
l -= data_len
if l: self.__close_tcp_socket()
except (socket.timeout, socket.error): self.__close_tcp_socket()
return buff if not l else None
def _stream_put_bytes(self, data, timeout_ms): # protected
i = 0
l = len(data)
if self.__valid_tcp_socket():
try:
self.__tcp__socket.settimeout(timeout_ms * 0.001)
while l:
data_len = self.__tcp__socket.send(data[i:i+min(l, 1400)])
if not data_len: break
i += data_len
l -= data_len
if l: self.__close_tcp_socket()
except (socket.timeout, socket.error): self.__close_tcp_socket()
if l: raise OSError # Stop Stream.
def get_can_settings(sampling_point):
for bs1 in range(8):
for bs2 in range(8):
if (1 + bs1 + bs2) == 8 and (sampling_point * 10) == (((1 + bs1) * 1000) // (1 + bs1 + bs2)):
return (bs1, bs2)
raise ValueError("Invalid sampling_point!")
class rpc_kvarser_can_master(rpc_master):
def __init__(self, channel, message_id=0x7FF, bit_rate=250000, sampling_point=75): # private
from canlib import canlib
self.__message_id = message_id
bs1, bs2 = get_can_settings(sampling_point)
self.__can = canlib.openChannel(channel=channel)
self.__can.setBusParams(freq=bit_rate, tseg1=bs1, tseg2=bs2, sjw=1)
self.__can.canSetAcceptanceFilter(code=message_id, mask=0x3FF)
self.__can.busOn()
rpc_master.__init__(self)
def _flush(self): # private
from canlib import canlib
self.__can.iocontrol.flush_rx_buffer()
def get_bytes(self, buff, timeout_ms): # protected
from canlib import canlib
l = len(buff)
for i in range(0, l, 8):
expected = min(l - i, 8)
try:
frame = self.__can.read(timeout=self._get_short_timeout)
if frame.id == self.__message_id and frame.dlc == expected: buff[i:i+8] = frame.data
else:
time.sleep(self._get_short_timeout * 0.001)
return None
except canlib.CanError:
time.sleep(self._get_short_timeout * 0.001)
return None
return buff
def put_bytes(self, data, timeout_ms): # protected
from canlib import canlib, Frame
view = memoryview(data)
for i in range(0, len(view), 8):
try: self.__can.writeWait(Frame(id_=self.__message_id, data=view[i:i+8]), timeout=self._put_short_timeout)
except canlib.CanError: break
class rpc_kvarser_can_slave(rpc_slave):
def __init__(self, channel, message_id=0x7FF, bit_rate=250000, sampling_point=75): # private
from canlib import canlib
self.__message_id = message_id
bs1, bs2 = get_can_settings(sampling_point)
self.__can = canlib.openChannel(channel=channel)
self.__can.setBusParams(freq=bit_rate, tseg1=bs1, tseg2=bs2, sjw=1)
self.__can.canSetAcceptanceFilter(code=message_id, mask=0x3FF)
self.__can.busOn()
rpc_slave.__init__(self)
def _flush(self): # private
from canlib import canlib
self.__can.iocontrol.flush_rx_buffer()
def get_bytes(self, buff, timeout_ms): # protected
from canlib import canlib
l = len(buff)
for i in range(0, l, 8):
expected = min(l - i, 8)
try:
frame = self.__can.read(timeout=self._get_short_timeout)
if frame.id == self.__message_id and frame.dlc == expected: buff[i:i+8] = frame.data
else: return None
except canlib.CanError: return None
return buff
def put_bytes(self, data, timeout_ms): # protected
from canlib import canlib, Frame
view = memoryview(data)
for i in range(0, len(view), 8):
try: self.__can.writeWait(Frame(id_=self.__message_id, data=view[i:i+8]), timeout=self._put_short_timeout)
except canlib.CanError: break

View File

@ -1,130 +0,0 @@
# Image Transfer - As The Controller Device
#
# This script is meant to talk to the "image_transfer_jpg_as_the_remote_device_for_your_computer.py" on the OpenMV Cam.
#
# This script shows off how to transfer the frame buffer to your computer as a jpeg image.
import io, pygame, rpc, serial, serial.tools.list_ports, socket, struct, sys
# Fix Python 2.x.
try: input = raw_input
except NameError: pass
# The RPC library above is installed on your OpenMV Cam and provides multiple classes for
# allowing your OpenMV Cam to control over USB or WIFI.
##############################################################
# Choose the interface you wish to control an OpenMV Cam over.
##############################################################
# Uncomment the below lines to setup your OpenMV Cam for controlling over a USB VCP.
#
# * port - Serial Port Name.
#
print("\nAvailable Ports:\n")
for port, desc, hwid in serial.tools.list_ports.comports():
print("{} : {} [{}]".format(port, desc, hwid))
sys.stdout.write("\nPlease enter a port name: ")
sys.stdout.flush()
interface = rpc.rpc_usb_vcp_master(port=input())
print("")
sys.stdout.flush()
# Uncomment the below line to setup your OpenMV Cam for controlling over WiFi.
#
# * slave_ip - IP address to connect to.
# * my_ip - IP address to bind to ("" to bind to all interfaces...)
# * port - Port to route traffic to.
#
# interface = rpc.rpc_network_master(slave_ip="xxx.xxx.xxx.xxx", my_ip="", port=0x1DBA)
##############################################################
# Call Back Handlers
##############################################################
def get_frame_buffer_call_back(pixformat_str, framesize_str, cutthrough, silent):
if not silent: print("Getting Remote Frame...")
result = interface.call("jpeg_image_snapshot", "%s,%s" % (pixformat_str, framesize_str))
if result is not None:
size = struct.unpack("<I", result)[0]
img = bytearray(size)
if cutthrough:
# Fast cutthrough data transfer with no error checking.
# Before starting the cut through data transfer we need to sync both the master and the
# slave device. On return both devices are in sync.
result = interface.call("jpeg_image_read")
if result is not None:
# GET BYTES NEEDS TO EXECUTE NEXT IMMEDIATELY WITH LITTLE DELAY NEXT.
# Read all the image data in one very large transfer.
interface.get_bytes(img, 5000) # timeout
else:
# Slower data transfer with error checking.
# Transfer 32 KB chunks.
chunk_size = (1 << 15)
if not silent: print("Reading %d bytes..." % size)
for i in range(0, size, chunk_size):
ok = False
for j in range(3): # Try up to 3 times.
result = interface.call("jpeg_image_read", struct.pack("<II", i, chunk_size))
if result is not None:
img[i:i+chunk_size] = result # Write the image data.
if not silent: print("%.2f%%" % ((i * 100) / size))
ok = True
break
if not silent: print("Retrying... %d/2" % (j + 1))
if not ok:
if not silent: print("Error!")
return None
return img
else:
if not silent: print("Failed to get Remote Frame!")
return None
pygame.init()
screen_w = 640
screen_h = 480
try:
screen = pygame.display.set_mode((screen_w, screen_h), flags=pygame.RESIZABLE)
except TypeError:
screen = pygame.display.set_mode((screen_w, screen_h))
pygame.display.set_caption("Frame Buffer")
clock = pygame.time.Clock()
while(True):
sys.stdout.flush()
# You may change the pixformat and the framesize of the image transferred from the remote device
# by modifying the below arguments.
#
# When cutthrough is False the image will be transferred through the RPC library with CRC and
# retry protection on all data moved. For faster data transfer set cutthrough to True so that
# get_bytes() and put_bytes() are called after an RPC call completes to transfer data
# more quickly from one image buffer to another. Note: This works because once an RPC call
# completes successfully both the master and slave devices are synchronized completely.
#
img = get_frame_buffer_call_back("sensor.RGB565", "sensor.QQVGA", cutthrough=True, silent=True)
if img is not None:
try:
screen.blit(pygame.transform.scale(pygame.image.load(io.BytesIO(img), "jpg"), (screen_w, screen_h)), (0, 0))
pygame.display.update()
clock.tick()
except pygame.error: pass
print(clock.get_fps())
for event in pygame.event.get():
if event.type == pygame.QUIT:
pygame.quit()
quit()

View File

@ -1,86 +0,0 @@
# Image Transfer - As The Controller Device
#
# This script is meant to talk to the "image_transfer_jpg_streaming_as_the_remote_device_for_your_computer.py" on the OpenMV Cam.
#
# This script shows off how to transfer the frame buffer to your computer as a jpeg image.
import io, pygame, rpc, serial, serial.tools.list_ports, socket, sys
# Fix Python 2.x.
try: input = raw_input
except NameError: pass
# The RPC library above is installed on your OpenMV Cam and provides multiple classes for
# allowing your OpenMV Cam to control over USB or WIFI.
##############################################################
# Choose the interface you wish to control an OpenMV Cam over.
##############################################################
# Uncomment the below lines to setup your OpenMV Cam for controlling over a USB VCP.
#
# * port - Serial Port Name.
#
print("\nAvailable Ports:\n")
for port, desc, hwid in serial.tools.list_ports.comports():
print("{} : {} [{}]".format(port, desc, hwid))
sys.stdout.write("\nPlease enter a port name: ")
sys.stdout.flush()
interface = rpc.rpc_usb_vcp_master(port=input())
print("")
sys.stdout.flush()
# Uncomment the below line to setup your OpenMV Cam for controlling over WiFi.
#
# * slave_ip - IP address to connect to.
# * my_ip - IP address to bind to ("" to bind to all interfaces...)
# * port - Port to route traffic to.
#
# interface = rpc.rpc_network_master(slave_ip="xxx.xxx.xxx.xxx", my_ip="", port=0x1DBA)
##############################################################
# Call Back Handlers
##############################################################
pygame.init()
screen_w = 640
screen_h = 480
try:
screen = pygame.display.set_mode((screen_w, screen_h), flags=pygame.RESIZABLE)
except TypeError:
screen = pygame.display.set_mode((screen_w, screen_h))
pygame.display.set_caption("Frame Buffer")
clock = pygame.time.Clock()
# This will be called with the bytes() object generated by the slave device.
def jpg_frame_buffer_cb(data):
sys.stdout.flush()
try:
screen.blit(pygame.transform.scale(pygame.image.load(io.BytesIO(data), "jpg"), (screen_w, screen_h)), (0, 0))
pygame.display.update()
clock.tick()
except pygame.error: pass
print(clock.get_fps())
for event in pygame.event.get():
if event.type == pygame.QUIT:
pygame.quit()
quit()
while(True):
sys.stdout.flush()
# You may change the pixformat and the framesize of the image transferred from the remote device
# by modifying the below arguments.
result = interface.call("jpeg_image_stream", "sensor.RGB565,sensor.QQVGA")
if result is not None:
# THE REMOTE DEVICE WILL START STREAMING ON SUCCESS. SO, WE NEED TO RECEIVE DATA IMMEDIATELY.
interface.stream_reader(jpg_frame_buffer_cb, queue_depth=8)
for event in pygame.event.get():
if event.type == pygame.QUIT:
pygame.quit()
quit()

View File

@ -1,159 +0,0 @@
# Remote Control - As The Controller Device
#
# This script remotely controls an OpenMV Cam using the RPC library.
#
# This script is meant to talk to the "popular_features_as_the_remote_device.py" on the OpenMV Cam.
import json, rpc, serial, serial.tools.list_ports, struct, sys
from datetime import datetime
# Fix Python 2.x.
try: input = raw_input
except NameError: pass
##############################################################
# Choose the interface you wish to control an OpenMV Cam over.
##############################################################
# Uncomment the below lines to setup your OpenMV Cam for controlling over a USB VCP.
#
# * port - Serial Port Name.
#
print("\nAvailable Ports:\n")
for port, desc, hwid in serial.tools.list_ports.comports():
print("{} : {} [{}]".format(port, desc, hwid))
sys.stdout.write("\nPlease enter a port name: ")
sys.stdout.flush()
interface = rpc.rpc_usb_vcp_master(port=input())
print("")
sys.stdout.flush()
# Uncomment the below line to setup your OpenMV Cam for controlling over WiFi.
#
# * slave_ip - IP address to connect to.
# * my_ip - IP address to bind to ("" to bind to all interfaces...)
# * port - Port to route traffic to.
#
# interface = rpc.rpc_network_master(slave_ip="xxx.xxx.xxx.xxx", my_ip="", port=0x1DBA)
# Uncomment the below lines to setup your OpenMV Cam for controlling over a UART (Serial / COM Port).
#
# * port - Serial Port Name.
# * baudrate - Bits per second.
#
# print("\nAvailable Ports:\n")
# for port, desc, hwid in serial.tools.list_ports.comports():
# print("{} : {} [{}]".format(port, desc, hwid))
# sys.stdout.write("\nPlease enter a port name: ")
# sys.stdout.flush()
# interface = rpc.rpc_uart_master(port=input(), baudrate=115200)
# print("")
# sys.stdout.flush()
# Uncomment the below line to setup your OpenMV Cam for controlling over CAN.
#
# * channel - Kvarser CAN channel number.
# * message_id - 11-bit message ID to use for data transport.
# * bit_rate - CAN baud rate.
# * sampling_point - Sampling point percentage.
#
# from canlib import canlib
# print("\nAvailable Channels:\n")
# for channel in range(canlib.getNumberOfChannels()):
# chdata = canlib.ChannelData(channel)
# print("%d. %s (%s / %s)" % (channel, chdata.channel_name, chdata.card_upc_no, chdata.card_serial_no))
# sys.stdout.write("\nPlease enter a channel name: ")
# sys.stdout.flush()
# interface = rpc.rpc_kvarser_can_master(channel=int(input()), message_id=0x7FF, bit_rate=250000, sampling_point=75)
# print("")
# sys.stdout.flush()
##############################################################
# Call Back Handlers
##############################################################
def exe_face_detection():
result = interface.call("face_detection")
if result is not None and len(result):
print("Largest Face Detected [x=%d, y=%d, w=%d, h=%d]" % struct.unpack("<HHHH", result))
def exe_qrcode_detection():
result = interface.call("qrcode_detection")
if result is not None and len(result):
print(result.tobytes())
def exe_all_qrcode_detection():
result = interface.call("all_qrcode_detection")
if result is not None and len(result):
print("QR Codes Detected:")
for obj in json.loads(result.tobytes()):
print(obj)
def exe_apriltag_detection():
result = interface.call("apriltag_detection")
if result is not None and len(result):
print("Largest Tag Detected [cx=%d, cy=%d, id=%d, rot=%d]" % struct.unpack("<HHHH",result))
def exe_all_apriltag_detection():
result = interface.call("all_apriltag_detection")
if result is not None and len(result):
print("Tags Detected:")
for obj in json.loads(result.tobytes()):
print(obj)
def exe_datamatrix_detection():
result = interface.call("datamatrix_detection")
if result is not None and len(result):
print(result.tobytes())
def exe_all_datamatrix_detection():
result = interface.call("all_datamatrix_detection")
if result is not None and len(result):
print("Data Matrices Detected:")
for obj in json.loads(result.tobytes()):
print(obj)
def exe_barcode_detection():
result = interface.call("barcode_detection")
if result is not None and len(result):
print(result.tobytes())
def exe_all_barcode_detection():
result = interface.call("all_barcode_detection")
if result is not None and len(result):
print("Bar Codes Detected:")
for obj in json.loads(result.tobytes()):
print(obj)
def exe_color_detection():
thresholds = (30, 100, 15, 127, 15, 127) # generic red thresholds
# thresholds = (30, 100, -64, -8, -32, 32) # generic green thresholds
# thresholds = (0, 30, 0, 64, -128, 0) # generic blue thresholds
result = interface.call("color_detection", struct.pack("<bbbbbb", *thresholds))
if result is not None and len(result):
print("Largest Color Detected [cx=%d, cy=%d]" % struct.unpack("<HH", result))
def exe_jpeg_snapshot():
result = interface.call("jpeg_snapshot")
if result is not None:
name = "snapshot-%s.jpg" % datetime.now().strftime("%d.%m.%Y-%H.%M.%S")
print("Writing jpeg %s..." % name)
with open(name, "wb") as snap:
snap.write(result)
# Execute remote functions in a loop. Please choose and uncomment one remote function below.
# Executing multiple at a time may run slowly if the camera needs to change camera modes
# per execution.
while(True):
exe_face_detection() # Face should be about 2ft away.
# exe_qrcode_detection() # Place the QRCode about 2ft away.
# exe_all_qrcode_detection() # Place the QRCode about 2ft away.
# exe_apriltag_detection()
# exe_all_apriltag_detection()
# exe_datamatrix_detection() # Place the Datamatrix about 2ft away.
# exe_all_datamatrix_detection() # Place the Datamatrix about 2ft away.
# exe_barcode_detection() # Place the Barcode about 2ft away.
# exe_all_barcode_detection() # Place the Barcode about 2ft away.
# exe_color_detection()
# exe_jpeg_snapshot()