#!/usr/bin/env python

import driveboard as b
import sys, time, random
import numpy as np

def run():
    #b.stop()
    #b.unstop()
    b.homing()
    b.feedrate(8000)
    b.air_on()
    for i, intensity in enumerate([30, 40, 50, 60, 70, 80, 90, 100]):
        b.intensity(0)
        b.move(0, i*2.0)
        b.intensity(intensity)
        b.move(80, i*2.0)
        b.intensity(0)
    b.move(0, 0)
    b.air_off()

    time.sleep(1)
    while True:
        s = b.status()
        if s['stops']:
            print s
            raise RuntimeError
        if s['ready']:
            break
        time.sleep(2)

try:
    b.connect()
    assert b.connected()
    print b.status()
    run()
finally:
    b.close()