summaryrefslogtreecommitdiffhomepage
path: root/digital/asserv/tools/step.py
blob: 238ba5a05d87fd3b2700c703870b7ee694afa516 (plain)
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
import sys
sys.path.append (sys.path[0] + '/../../../host/proto')

from asserv import Asserv
import popen_io
import serial
import Gnuplot

def step (name, kp, ki, kd, plots):
    if sys.argv[1] == '!':
	io = popen_io.PopenIO (sys.argv[2:])
    else:
	io = serial.Serial (sys.argv[1])
    a = Asserv (io, **{ name + 'kp': kp, name + 'ki': ki, name + 'kd': kd})
    a.stats ('PW')
    a.consign (name, 0x200)
    a.wait (lambda: a.stats_count > 225 * 2)
    list = a.get_stats ()
    a.reset ()
    a.wait (lambda: True)

    g = Gnuplot.Gnuplot (persist = True)
    g ('set data style lines')
    g.plot (*[Gnuplot.Data (list, cols = i) for i in plots])

step ('t', 1, 0, 16, (0, 6, 7))
#step ('a', 1, 0, 16, (2, 6, 7))
#step ('a0', 1, 0, 16, (4, 8))