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
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
|
import sys
sys.path.insert(0, '/home/pi/pendulum/System')
from System.system import System
import time
from sys import exit
#import pandas
###
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)
exit()
#class test():
# def __init__(self, x, theta):
# self.x = 0
# self.theta = 0
#
# def getINFO(self, theta):
# #theta, x = self.System.measure()
# theta, x = self.sys.measure()
#
#while(1):
# test.getINFO()
# print("t")
# #print("theta",test.theta)
# #print("x",test.x)
#
|
