blob: 27f5835d1213f14b74f2b96bc0a79c2b12b289cb (
plain) (
blame)
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
29
30
31
32
33
34
35
36
37
38
39
40
41
42
|
import sys
sys.path.insert(0, '/home/pi/pendulum/System')
from System.system import System
import time
from sys import exit
sys.path.insert(0, '/home/pi/pendulum/System')
from encoder import Encoder
import RPi.GPIO as GPIO
clk_pin = 3
cs_pin = 23
data_pin = 2
e = Encoder(clk_pin, cs_pin, data_pin)
e.set_zero()
sys = System(angular_units = 'Radians')
for x in range(4,20):
linear = 0
print("beginning of test with speed " + str(x))
while linear > -7:
sys.adjust(-5)
angle, linear = sys.measure()
print("Angle: " + str(angle) + ", Linear: " + str(linear))
time.sleep(0.1)
sys.adjust(0)
time.sleep(3)
sys.add_log("this is a test with speed " + str(x))
while linear < 7:
sys.adjust(x)
angle, linear = sys.measure()
print("Angle: " + str(angle) + ", Linear: " + str(linear))
sys.add_results(e.read_position('Degrees'), linear, x)
time.sleep(0.1)
sys.adjust(0)
print("end of test with speed " + str(x))
time.sleep(3)
deinitialize()
exit()
|
