test_ssc32.py

#!/usr/bin/env python
from __future__ import print_function
from matplotlib.pyplot import *
from numpy import *
from numpy.random import *

from hardwarex import *

bExit = 0

# This function should be called when a key is pressed.
def on_key(event):
    # Global variables to share with other functions.
    global bExit
    # Actions to do depending on the key pressed.
    #print('You pressed', event.key, event.xdata, event.ydata)
    if event.key == 'escape':
        bExit = 1

pSSC32 = CreateSSC32()
# Check and modify the configuration file if needed...
result = ConnectSSC32(pSSC32, 'SSC320.txt')

pause(0.1)
result = SetPWMSSC32(pSSC32, 0, 1350)
pause(0.5)
nbchannels = 32
selectedchannels = zeros(nbchannels, int)
selectedchannels[0] = 1; selectedchannels[1] = 1; selectedchannels[2] = 1
pws = zeros(nbchannels, int)
pws[0] = int(1000); pws[1] = int(2000); pws[2] = int(1000)
result = SetAllPWMsSSC32(pSSC32, selectedchannels, pws)
pause(0.1)
result = GetVoltageSSC32(pSSC32, 0)
value = result[1]
print('value = ',value,'\n')

ion() # Turn the interactive mode on.

# Create a figure that will use the function on_key() when a key is
# pressed.
fig = figure('Test')
cid = fig.canvas.mpl_connect('key_press_event',on_key)

# If SetPWMSSC32(), SetAllPWMsSSC32()... take too much time, use a thread to access data faster...
result = StartThreadSSC32(pSSC32)

a = 0
while (bExit == 0):
    clf(); axis('square'); axis([-200,200,-200,200])
    if (mod(a, 2) == 0):
        pws[0] = int(1000); pws[1] = int(2000); pws[2] = int(1250)
    else:
        pws[0] = int(2000); pws[1] = int(1000); pws[2] = int(1750)
    result = SetAllPWMsFromThreadSSC32(pSSC32, selectedchannels, pws)    
    a = a+1
    str = 'a = %d\n'%(a)
    text(-150,0,str)
    pause(2)

result = StopThreadSSC32(pSSC32)
result = DisconnectSSC32(pSSC32)
DestroySSC32(pSSC32)