blob: 4b5323ab87a46dfee70962c421937cc8a57caa54 (
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
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
|
import os
import sys
cwd=os.getcwd()
(setpath,Examples)=os.path.split(cwd)
#print setpath
sys.path.append(setpath)
from Arduino.Arduino import Arduino
from time import sleep
class SERVO_POT:
def __init__(self,baudrate):
self.baudrate=baudrate
self.setup()
self.run()
self.exit()
def setup(self):
self.obj_arduino=Arduino()
self.port=self.obj_arduino.locateport()
self.obj_arduino.open_serial(1,self.port,self.baudrate)
def run(self):
self.pin1=9
self.pot=2
self.pos=0
self.obj_arduino.cmd_servo_attach(1,1)
sleep(1)
self.angle=18
for i in range(100):
val=self.obj_arduino.cmd_analog_in(1,self.pot)
print (val)
val = int(val*180/1023)
print (val)
self.obj_arduino.cmd_servo_move(1,1,val)
sleep(0.5)
self.obj_arduino.cmd_servo_detach(1,1)
def exit(self):
self.obj_arduino.close_serial()
def main():
obj_servo=SERVO_POT(115200)
if __name__=='__main__':
main()
|
