-
Notifications
You must be signed in to change notification settings - Fork 487
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
Implementing serial support over IP socket
Co-authored-by: thejomas <[email protected]>
- Loading branch information
Showing
5 changed files
with
146 additions
and
5 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,112 @@ | ||
| import logging | ||
| import os | ||
| import socket | ||
| import sys | ||
|
|
||
| logger = logging.getLogger(__name__) | ||
|
|
||
| SERIAL_FREQ = 8192 # Hz | ||
| CPU_FREQ = 4213440 # Hz | ||
|
|
||
|
|
||
| class Serial: | ||
| def __init__(self, serial_address, serial_bind, serial_interrupt_based=True): | ||
| self.SB = 0 | ||
| self.SC = 0 | ||
| self.connection = None | ||
|
|
||
| self.trans_bits = 0 | ||
| self.cycles_count = 0 | ||
| self.cycles_target = CPU_FREQ // SERIAL_FREQ | ||
| self.serial_interrupt_based = serial_interrupt_based | ||
|
|
||
| if not serial_address: | ||
| logger.info("No serial address supplied. Link Cable emulation disabled.") | ||
| return | ||
|
|
||
| if not serial_address.count(".") == 3 and serial_address.count(":") == 1: | ||
| logger.info("Only IP-addresses of the format x.y.z.w:abcd is supported") | ||
| return | ||
|
|
||
| address_ip, address_port = serial_address.split(":") | ||
| address_tuple = (address_ip, int(address_port)) | ||
|
|
||
| if serial_bind: | ||
| self.binding_connection = socket.socket(socket.AF_INET, socket.SOCK_STREAM) | ||
| self.binding_connection.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEADDR, 1) | ||
| logger.info(f"Binding to {serial_address}") | ||
| self.binding_connection.bind(address_tuple) | ||
| self.binding_connection.listen(1) | ||
| self.connection, _ = self.binding_connection.accept() | ||
| logger.info(f"Client has connected!") | ||
| else: | ||
| self.connection = socket.socket(socket.AF_INET, socket.SOCK_STREAM) | ||
| logger.info(f"Connecting to {serial_address}") | ||
| self.connection.connect(address_tuple) | ||
| logger.info(f"Connection successful!") | ||
| # self.connection.setblocking(False) | ||
|
|
||
| def tick(self, cycles): | ||
| # if self.serial_interrupt_based: | ||
| # if self.SC & 1: # Master | ||
| # if self.SC & 0x80: | ||
| # logger.info(f'Master sending!') | ||
| # self.connection.send(bytes([self.SB])) | ||
| # # self.connection.setblocking(True) | ||
| # data = self.connection.recv(1) | ||
| # self.SB = data[0] | ||
| # self.SC &= 0b0111_1111 | ||
| # return True | ||
| # else: | ||
| # try: | ||
| # if self.SC & 0x80: | ||
| # # self.connection.setblocking(False) | ||
| # logger.info(f'Slave recv!') | ||
| # self.connection.send(bytes([self.SB])) | ||
| # data = self.connection.recv(1) | ||
| # self.SB = data[0] | ||
| # self.SC &= 0b0111_1111 | ||
| # return True | ||
| # except BlockingIOError: | ||
| # pass | ||
| # return False | ||
| # return False | ||
| # else: | ||
| # Check if serial is in progress | ||
|
|
||
| if self.connection is None: | ||
| return | ||
|
|
||
| if self.SC & 0x80 == 0: | ||
| return False | ||
|
|
||
| self.cycles_count += 1 | ||
|
|
||
| if (self.cycles_to_transmit() == 0): | ||
| # if self.SC & 1: # Master | ||
| send_bit = bytes([(self.SB >> 7) & 1]) | ||
| self.connection.send(send_bit) | ||
|
|
||
| data = self.connection.recv(1) | ||
| self.SB = ((self.SB << 1) & 0xFF) | data[0] & 1 | ||
|
|
||
| logger.info(f"recv sb: {self.SB:08b}") | ||
| self.trans_bits += 1 | ||
|
|
||
| self.cycles_count = 0 | ||
|
|
||
| if self.trans_bits == 8: | ||
| self.trans_bits = 0 | ||
| self.SC &= 0b0111_1111 | ||
| return True | ||
| return False | ||
|
|
||
| def cycles_to_transmit(self): | ||
| if self.SC & 0x80: | ||
| return max(self.cycles_target - self.cycles_count, 0) | ||
| else: | ||
| return 1 << 16 | ||
|
|
||
| def stop(self): | ||
| if self.connection: | ||
| self.connection.close() |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters