forked from micropython/micropython
-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathmachine_can_02_rx_callback.py
More file actions
122 lines (85 loc) · 3.7 KB
/
Copy pathmachine_can_02_rx_callback.py
File metadata and controls
122 lines (85 loc) · 3.7 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
from machine import CAN
import time
# Test the CAN.IRQ_RX irq handler, including overflow
rx_overflow = False
rx_full = False
received = []
# CAN IDs
ID_SPAM = 0x345 # messages spammed into the receive FIFO
ID_ACK_OFLOW = 0x055 # message the receiver sends after it's seen an overflow
ID_AFTER = 0x100 # message the sender sends after the ACK
can = CAN(1, 500_000)
# A very basic "soft" receiver handler that stores received messages into a global list
def receiver_irq_recv(can):
global rx_overflow, rx_full
assert can.irq().flags() & can.IRQ_RX # the only enabled IRQ
can_id, data, _flags, errors = can.recv()
received.append((can_id, None))
# The FIFO is expected not to overflow by itself, wait until 40 messages
# have been received and then block the receive handler to induce an overflow
if len(received) == 40:
assert not rx_overflow # shouldn't have already happened, either
time.sleep_ms(500)
if not rx_overflow and (errors & CAN.RECV_ERR_OVERRUN):
# expected this should happen on the very next message after
# the one where we slept for 500ms
print("irq_recv overrun", len(received))
received.clear() # check we still get some messages, see rx_spam print line below
rx_overflow = True
# also expect the FIFO to be FULL again immediately after overrunning and rx_overflow event
if rx_overflow and (errors & CAN.RECV_ERR_OVERRUN | CAN.RECV_ERR_FULL) == CAN.RECV_ERR_FULL:
rx_full = True
# Receiver
def instance0():
can.irq(receiver_irq_recv, trigger=can.IRQ_RX, hard=False)
can.set_filters(None) # receive all
multitest.next()
while not rx_overflow:
pass # Resume ASAP after FIFO0 overflows
can.send(ID_ACK_OFLOW, b"overflow")
# at least one ID_SPAM message should have been received
# *after* we overflowed and 'received' was clear in the irq handler
print("rx_spam", any(r[0] == ID_SPAM for r in received))
# wait until the "after" message is received
for n in range(100):
if any(r[0] == ID_AFTER for r in received):
break
time.sleep_ms(10)
can.irq(None) # disable the IRQ
received.clear()
# at some point while waiting for ID_AFTER the FIFO should have gotten
# full again
print("rx_full", rx_full)
# now IRQ is disabled, no new messages should be received
time.sleep_ms(250)
print("len", len(received))
received_ack = False
# reusing the result buffer so sender_irq_recv can be 'hard'
sender_irq_result = [None, memoryview(bytearray(64)), None, None]
def sender_irq_recv(can):
global received_ack
assert can.irq().flags() & can.IRQ_RX # the only enabled IRQ
can_id, data, _flags, _errors = can.recv(sender_irq_result)
print("sender_irq_recv", can_id, len(data)) # should be ID_ACK_OFLOW and "overflow" payload
received_ack = True
# Sender
def instance1():
can.irq(sender_irq_recv, CAN.IRQ_RX, hard=True)
can.set_filters(None)
multitest.next()
# Spam out messages until the receiver tells us its RX FIFO is full.
#
# The RX FIFO on the receiver can vary from 3 deep (BXCAN) to 25 deep (STM32H7),
# so we keep sending to it until we see a CAN message on ID_ACK_OFLOW indicating
# the receiver's FIFO has overflowed
while not received_ack:
for i in range(255):
while can.send(ID_SPAM, bytes([i] * 8)) is None and not received_ack:
# Don't overflow the TX FIFO
time.sleep_ms(1)
if received_ack:
break
# give the receiver some time to make space in the FIFO
time.sleep_ms(200)
# send the final message, the receiver should get this one
can.send(ID_AFTER, b"aaaaa")