Compare commits
3 Commits
68c1ff13eb
...
2efee051ff
Author | SHA1 | Date | |
---|---|---|---|
|
2efee051ff | ||
|
ca54784e64 | ||
|
71d952dce5 |
|
@ -3,6 +3,9 @@ name = "soft-serial"
|
||||||
version = "0.1.0"
|
version = "0.1.0"
|
||||||
edition = "2021"
|
edition = "2021"
|
||||||
|
|
||||||
|
[dependencies.ring-buffer]
|
||||||
|
git = "https://gitea.doryan04.ru/doryan/ring-buffer"
|
||||||
|
|
||||||
[dependencies.arduino-hal]
|
[dependencies.arduino-hal]
|
||||||
git = "https://github.com/rahix/avr-hal"
|
git = "https://github.com/rahix/avr-hal"
|
||||||
rev = "3e362624547462928a219c40f9ea8e3a64f21e5f"
|
rev = "3e362624547462928a219c40f9ea8e3a64f21e5f"
|
||||||
|
@ -12,6 +15,7 @@ git = "https://gitea.doryan04.ru/TheEmbeddedRust/static-pins"
|
||||||
|
|
||||||
[features]
|
[features]
|
||||||
sparkfun-promicro = ["arduino-hal/sparkfun-promicro", "static-pins/sparkfun-promicro"]
|
sparkfun-promicro = ["arduino-hal/sparkfun-promicro", "static-pins/sparkfun-promicro"]
|
||||||
|
ring-buffer = ["dep:ring-buffer"]
|
||||||
|
|
||||||
[dependencies.avr-device]
|
[dependencies.avr-device]
|
||||||
version = "0.5.4"
|
version = "0.5.4"
|
||||||
|
|
51
src/lib.rs
51
src/lib.rs
|
@ -28,8 +28,12 @@ const SECOND_HALF_SERIAL_DELAY: u32 = SERIAL_DELAY - FIRST_HALF_SERIAL_DELAY;
|
||||||
|
|
||||||
const READING_ADJUST: u32 = 16;
|
const READING_ADJUST: u32 = 16;
|
||||||
const FIRST_ENTRY_READING: u32 = 30;
|
const FIRST_ENTRY_READING: u32 = 30;
|
||||||
const LSB: u8 = 0x01;
|
const MSB: u16 = 0x0200;
|
||||||
const MSB: u8 = 0x80;
|
|
||||||
|
#[inline(always)]
|
||||||
|
fn crc_calculate(value: u8) -> u8 {
|
||||||
|
((value >> 6) | (value >> 4) | (value >> 2) | value) & 0x0F
|
||||||
|
}
|
||||||
|
|
||||||
pub enum PollError {
|
pub enum PollError {
|
||||||
NotFound,
|
NotFound,
|
||||||
|
@ -53,7 +57,7 @@ where
|
||||||
|
|
||||||
pub fn poll(&self) -> PollResult {
|
pub fn poll(&self) -> PollResult {
|
||||||
P::into_output();
|
P::into_output();
|
||||||
delay_cycles(1);
|
delay_cycles(4);
|
||||||
P::into_pull_up_input();
|
P::into_pull_up_input();
|
||||||
|
|
||||||
delay_us(SERIAL_DELAY);
|
delay_us(SERIAL_DELAY);
|
||||||
|
@ -127,31 +131,19 @@ where
|
||||||
{
|
{
|
||||||
#[inline(never)]
|
#[inline(never)]
|
||||||
fn write_byte(&self, transmit_data: u8) {
|
fn write_byte(&self, transmit_data: u8) {
|
||||||
let (mut data, mut parity_bit) = (transmit_data, 0);
|
let mut data = ((transmit_data as u16) << 4) | (crc_calculate(transmit_data) as u16);
|
||||||
|
|
||||||
for _ in 0..8 {
|
for _ in 0..(u8::BITS + 4) {
|
||||||
if data & MSB == 0 {
|
if data & MSB == 0 {
|
||||||
P::set_high();
|
P::set_high();
|
||||||
parity_bit ^= 0;
|
|
||||||
} else {
|
} else {
|
||||||
P::set_low();
|
P::set_low();
|
||||||
parity_bit ^= 1;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
delay_us(SERIAL_DELAY);
|
delay_us(SERIAL_DELAY);
|
||||||
|
|
||||||
data <<= 1;
|
data <<= 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Hamming code and CRC are very weightful and slow, so I use simple parity check
|
|
||||||
|
|
||||||
if parity_bit == 0 {
|
|
||||||
P::set_high();
|
|
||||||
} else {
|
|
||||||
P::set_low();
|
|
||||||
}
|
|
||||||
|
|
||||||
delay_us(SERIAL_DELAY);
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -161,35 +153,30 @@ where
|
||||||
{
|
{
|
||||||
#[inline(never)]
|
#[inline(never)]
|
||||||
fn read_byte(&self) -> ReadByteResult {
|
fn read_byte(&self) -> ReadByteResult {
|
||||||
let (mut data, mut reciever_parity_bit) = (0, 0);
|
let mut packet = 0u16;
|
||||||
|
|
||||||
delay_cycles(FIRST_ENTRY_READING);
|
delay_cycles(FIRST_ENTRY_READING);
|
||||||
for _ in 0..8 {
|
for _ in 0..(u8::BITS + 4) {
|
||||||
delay_us(FIRST_HALF_SERIAL_DELAY);
|
delay_us(FIRST_HALF_SERIAL_DELAY);
|
||||||
|
|
||||||
data <<= 1;
|
packet <<= 1;
|
||||||
|
|
||||||
if P::is_low() {
|
if P::is_low() {
|
||||||
data |= 1;
|
packet |= 1;
|
||||||
reciever_parity_bit ^= 1;
|
|
||||||
} else {
|
} else {
|
||||||
data |= 0;
|
packet |= 0;
|
||||||
reciever_parity_bit ^= 0;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
delay_cycles(READING_ADJUST);
|
delay_cycles(READING_ADJUST);
|
||||||
delay_us(SECOND_HALF_SERIAL_DELAY);
|
delay_us(SECOND_HALF_SERIAL_DELAY);
|
||||||
}
|
}
|
||||||
|
|
||||||
delay_us(FIRST_HALF_SERIAL_DELAY);
|
let received_crc = (packet & 0x000F) as u8;
|
||||||
|
let data = packet.overflowing_shr(4).0 as u8;
|
||||||
|
let calculated_crc = crc_calculate(data);
|
||||||
|
|
||||||
let transmitter_parity_bit = (P::read() >> P::PIN_NUM) & LSB;
|
if received_crc != calculated_crc {
|
||||||
|
return Err((received_crc, calculated_crc));
|
||||||
delay_cycles(READING_ADJUST);
|
|
||||||
delay_us(SECOND_HALF_SERIAL_DELAY);
|
|
||||||
|
|
||||||
if reciever_parity_bit == transmitter_parity_bit {
|
|
||||||
return Err((data, reciever_parity_bit));
|
|
||||||
}
|
}
|
||||||
|
|
||||||
Ok(data)
|
Ok(data)
|
||||||
|
|
|
@ -9,106 +9,7 @@ use crate::{
|
||||||
SoftSerialWriter,
|
SoftSerialWriter,
|
||||||
};
|
};
|
||||||
|
|
||||||
#[derive(Debug, Clone, Copy)]
|
#[cfg(feature = "ring-buffer")]
|
||||||
pub struct RingBuffer<const N: usize> {
|
|
||||||
buf: [u8; N],
|
|
||||||
mask: usize,
|
|
||||||
head: usize,
|
|
||||||
tail: usize,
|
|
||||||
}
|
|
||||||
|
|
||||||
impl<const N: usize> Default for RingBuffer<N> {
|
|
||||||
fn default() -> Self {
|
|
||||||
Self::new()
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
impl<const N: usize> RingBuffer<N> {
|
|
||||||
#[inline]
|
|
||||||
pub const fn new() -> Self {
|
|
||||||
if N.is_power_of_two() {
|
|
||||||
Self {
|
|
||||||
buf: [0; N],
|
|
||||||
mask: N - 1,
|
|
||||||
head: 0,
|
|
||||||
tail: 0,
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
panic!("Buffer capacity isn't power of two");
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn get_buffer(&self) -> &[u8] {
|
|
||||||
&self.buf
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn is_empty(&self) -> bool {
|
|
||||||
self.head == self.tail
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn is_full(&self) -> bool {
|
|
||||||
(self.head + 1) & self.mask == self.tail
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn capacity(&self) -> usize {
|
|
||||||
N
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn len(&self) -> usize {
|
|
||||||
self.head.overflowing_sub(self.tail).0 & self.mask
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn clear(&mut self) {
|
|
||||||
self.buf = [0; N];
|
|
||||||
self.head = 0;
|
|
||||||
self.tail = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn push(&mut self, value: u8) -> Option<()> {
|
|
||||||
let (head, tail) = (self.head, self.tail);
|
|
||||||
let next_head = (head + 1) & self.mask;
|
|
||||||
|
|
||||||
if next_head == tail {
|
|
||||||
return None;
|
|
||||||
}
|
|
||||||
|
|
||||||
self.buf[head] = value;
|
|
||||||
self.head = next_head;
|
|
||||||
|
|
||||||
Some(())
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn pop(&mut self) -> Option<u8> {
|
|
||||||
let (head, mut tail) = (self.head, self.tail);
|
|
||||||
|
|
||||||
if head == tail {
|
|
||||||
return None;
|
|
||||||
}
|
|
||||||
|
|
||||||
let value = self.buf[tail];
|
|
||||||
tail = (tail + 1) & self.mask;
|
|
||||||
self.tail = tail;
|
|
||||||
|
|
||||||
Some(value)
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
impl<const N: usize> Iterator for RingBuffer<N> {
|
|
||||||
type Item = u8;
|
|
||||||
|
|
||||||
fn next(&mut self) -> Option<Self::Item> {
|
|
||||||
self.pop()
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
impl<const N: usize, P> SoftSerialWriter<P, &mut RingBuffer<N>> for HalfDuplexSerial<P>
|
impl<const N: usize, P> SoftSerialWriter<P, &mut RingBuffer<N>> for HalfDuplexSerial<P>
|
||||||
where
|
where
|
||||||
P: PinOps + StaticPinOps,
|
P: PinOps + StaticPinOps,
|
||||||
|
@ -124,6 +25,7 @@ where
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#[cfg(feature = "ring-buffer")]
|
||||||
impl<const N: usize, P> SoftSerialReader<P, &mut RingBuffer<N>> for HalfDuplexSerial<P>
|
impl<const N: usize, P> SoftSerialReader<P, &mut RingBuffer<N>> for HalfDuplexSerial<P>
|
||||||
where
|
where
|
||||||
P: PinOps + StaticPinOps,
|
P: PinOps + StaticPinOps,
|
||||||
|
@ -137,7 +39,7 @@ where
|
||||||
self.sync_reciever();
|
self.sync_reciever();
|
||||||
|
|
||||||
if let Ok(byte) = self.read_byte() {
|
if let Ok(byte) = self.read_byte() {
|
||||||
recieve_data.push(byte).unwrap_or(());
|
recieve_data.push(byte);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue