206 lines
5.1 KiB
Python
206 lines
5.1 KiB
Python
import sys
|
|
import time
|
|
from panda import Panda
|
|
from nose.tools import assert_equal, assert_less, assert_greater
|
|
from .helpers import start_heartbeat_thread, reset_pandas, SPEED_NORMAL, SPEED_GMLAN, time_many_sends, test_white_and_grey, panda_type_to_serial, test_all_pandas, panda_connect_and_init
|
|
|
|
# Reset the pandas before running tests
|
|
def aaaa_reset_before_tests():
|
|
reset_pandas()
|
|
|
|
@test_all_pandas
|
|
@panda_connect_and_init
|
|
def test_can_loopback(p):
|
|
# Start heartbeat
|
|
start_heartbeat_thread(p)
|
|
|
|
# enable output mode
|
|
p.set_safety_mode(Panda.SAFETY_ALLOUTPUT)
|
|
|
|
# enable CAN loopback mode
|
|
p.set_can_loopback(True)
|
|
|
|
if p.legacy:
|
|
busses = [0, 1]
|
|
else:
|
|
busses = [0, 1, 2]
|
|
|
|
for bus in busses:
|
|
# set bus 0 speed to 250
|
|
p.set_can_speed_kbps(bus, 250)
|
|
|
|
# send a message on bus 0
|
|
p.can_send(0x1aa, b"message", bus)
|
|
|
|
# confirm receive both on loopback and send receipt
|
|
time.sleep(0.05)
|
|
r = p.can_recv()
|
|
sr = [x for x in r if x[3] == 0x80 | bus]
|
|
lb = [x for x in r if x[3] == bus]
|
|
assert len(sr) == 1
|
|
assert len(lb) == 1
|
|
|
|
# confirm data is correct
|
|
assert 0x1aa == sr[0][0] == lb[0][0]
|
|
assert b"message" == sr[0][2] == lb[0][2]
|
|
|
|
@test_all_pandas
|
|
@panda_connect_and_init
|
|
def test_safety_nooutput(p):
|
|
# Start heartbeat
|
|
start_heartbeat_thread(p)
|
|
|
|
# enable output mode
|
|
p.set_safety_mode(Panda.SAFETY_SILENT)
|
|
|
|
# enable CAN loopback mode
|
|
p.set_can_loopback(True)
|
|
|
|
# send a message on bus 0
|
|
p.can_send(0x1aa, b"message", 0)
|
|
|
|
# confirm receive nothing
|
|
time.sleep(0.05)
|
|
r = p.can_recv()
|
|
assert len(r) == 0
|
|
|
|
@test_all_pandas
|
|
@panda_connect_and_init
|
|
def test_reliability(p):
|
|
LOOP_COUNT = 100
|
|
MSG_COUNT = 100
|
|
|
|
# Start heartbeat
|
|
start_heartbeat_thread(p)
|
|
|
|
# enable output mode
|
|
p.set_safety_mode(Panda.SAFETY_ALLOUTPUT)
|
|
p.set_can_loopback(True)
|
|
p.set_can_speed_kbps(0, 1000)
|
|
|
|
addrs = list(range(100, 100 + MSG_COUNT))
|
|
ts = [(j, 0, b"\xaa" * 8, 0) for j in addrs]
|
|
|
|
# 100 loops
|
|
for i in range(LOOP_COUNT):
|
|
st = time.time()
|
|
|
|
p.can_send_many(ts)
|
|
|
|
r = []
|
|
while len(r) < 200 and (time.time() - st) < 0.5:
|
|
r.extend(p.can_recv())
|
|
|
|
sent_echo = [x for x in r if x[3] == 0x80]
|
|
loopback_resp = [x for x in r if x[3] == 0]
|
|
|
|
assert_equal(sorted([x[0] for x in loopback_resp]), addrs)
|
|
assert_equal(sorted([x[0] for x in sent_echo]), addrs)
|
|
assert_equal(len(r), 200)
|
|
|
|
# take sub 20ms
|
|
et = (time.time() - st) * 1000.0
|
|
assert_less(et, 20)
|
|
|
|
sys.stdout.write("P")
|
|
sys.stdout.flush()
|
|
|
|
@test_all_pandas
|
|
@panda_connect_and_init
|
|
def test_throughput(p):
|
|
# Start heartbeat
|
|
start_heartbeat_thread(p)
|
|
|
|
# enable output mode
|
|
p.set_safety_mode(Panda.SAFETY_ALLOUTPUT)
|
|
|
|
# enable CAN loopback mode
|
|
p.set_can_loopback(True)
|
|
|
|
for speed in [100, 250, 500, 750, 1000]:
|
|
# set bus 0 speed to speed
|
|
p.set_can_speed_kbps(0, speed)
|
|
time.sleep(0.05)
|
|
|
|
comp_kbps = time_many_sends(p, 0)
|
|
|
|
# bit count from https://en.wikipedia.org/wiki/CAN_bus
|
|
saturation_pct = (comp_kbps / speed) * 100.0
|
|
assert_greater(saturation_pct, 80)
|
|
assert_less(saturation_pct, 100)
|
|
|
|
print("loopback 100 messages at speed %d, comp speed is %.2f, percent %.2f" % (speed, comp_kbps, saturation_pct))
|
|
|
|
@test_white_and_grey
|
|
@panda_type_to_serial
|
|
@panda_connect_and_init
|
|
def test_gmlan(p):
|
|
if p.legacy:
|
|
return
|
|
|
|
# Start heartbeat
|
|
start_heartbeat_thread(p)
|
|
|
|
# enable output mode
|
|
p.set_safety_mode(Panda.SAFETY_ALLOUTPUT)
|
|
|
|
# enable CAN loopback mode
|
|
p.set_can_loopback(True)
|
|
|
|
p.set_can_speed_kbps(1, SPEED_NORMAL)
|
|
p.set_can_speed_kbps(2, SPEED_NORMAL)
|
|
p.set_can_speed_kbps(3, SPEED_GMLAN)
|
|
|
|
# set gmlan on CAN2
|
|
for bus in [Panda.GMLAN_CAN2, Panda.GMLAN_CAN3, Panda.GMLAN_CAN2, Panda.GMLAN_CAN3]:
|
|
p.set_gmlan(bus)
|
|
comp_kbps_gmlan = time_many_sends(p, 3)
|
|
assert_greater(comp_kbps_gmlan, 0.8 * SPEED_GMLAN)
|
|
assert_less(comp_kbps_gmlan, 1.0 * SPEED_GMLAN)
|
|
|
|
p.set_gmlan(None)
|
|
comp_kbps_normal = time_many_sends(p, bus)
|
|
assert_greater(comp_kbps_normal, 0.8 * SPEED_NORMAL)
|
|
assert_less(comp_kbps_normal, 1.0 * SPEED_NORMAL)
|
|
|
|
print("%d: %.2f kbps vs %.2f kbps" % (bus, comp_kbps_gmlan, comp_kbps_normal))
|
|
|
|
@test_white_and_grey
|
|
@panda_type_to_serial
|
|
@panda_connect_and_init
|
|
def test_gmlan_bad_toggle(p):
|
|
if p.legacy:
|
|
return
|
|
|
|
# Start heartbeat
|
|
start_heartbeat_thread(p)
|
|
|
|
# enable output mode
|
|
p.set_safety_mode(Panda.SAFETY_ALLOUTPUT)
|
|
|
|
# enable CAN loopback mode
|
|
p.set_can_loopback(True)
|
|
|
|
# GMLAN_CAN2
|
|
for bus in [Panda.GMLAN_CAN2, Panda.GMLAN_CAN3]:
|
|
p.set_gmlan(bus)
|
|
comp_kbps_gmlan = time_many_sends(p, 3)
|
|
assert_greater(comp_kbps_gmlan, 0.6 * SPEED_GMLAN)
|
|
assert_less(comp_kbps_gmlan, 1.0 * SPEED_GMLAN)
|
|
|
|
# normal
|
|
for bus in [Panda.GMLAN_CAN2, Panda.GMLAN_CAN3]:
|
|
p.set_gmlan(None)
|
|
comp_kbps_normal = time_many_sends(p, bus)
|
|
assert_greater(comp_kbps_normal, 0.6 * SPEED_NORMAL)
|
|
assert_less(comp_kbps_normal, 1.0 * SPEED_NORMAL)
|
|
|
|
|
|
# this will fail if you have hardware serial connected
|
|
@test_all_pandas
|
|
@panda_connect_and_init
|
|
def test_serial_debug(p):
|
|
_ = p.serial_read(Panda.SERIAL_DEBUG) # junk
|
|
p.call_control_api(0xc0)
|
|
assert(p.serial_read(Panda.SERIAL_DEBUG).startswith(b"can "))
|