#!/usr/bin/env python
import time
import random
bad = 0
count = 2000
for i in range(count):
    speed1 = random.random()
    speed2 = random.random()
    PBR.SetMotor1(speed1)
    PBR.SetMotor2(speed2)
    time.sleep(0.1)
    read1 = PBR.GetMotor1()
    read2 = PBR.GetMotor2()
    failed = False
    if abs(read1 - speed1) > 0.02:
        failed = True
    if abs(read2 - speed2) > 0.02:
        failed = True
    if failed:
        print '%04d: Failed %.2f, %.2f instead of %.2f, %.2f' % (i+1, read1, read2, speed1, speed2)
        bad += 1
PBR.MotorsOff()
if bad == 0:
    print 'All okay (%d runs)' % (count)
else:
    print '%d of %d failed!' % (bad, count)