-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathNerfTurret.py
87 lines (75 loc) · 2.17 KB
/
NerfTurret.py
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
82
83
84
85
86
87
#!/usr/bin/env python
# -*- coding: utf-8 -*-
#
# main.py
#
# Copyright 2020 <pi@raspberrypi>
#
# This program is free software; you can redistribute it and/or modify
# it under the terms of the GNU General Public License as published by
# the Free Software Foundation; either version 2 of the License, or
# (at your option) any later version.
#
# This program is distributed in the hope that it will be useful,
# but WITHOUT ANY WARRANTY; without even the implied warranty of
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
# GNU General Public License for more details.
#
# You should have received a copy of the GNU General Public License
# along with this program; if not, write to the Free Software
# Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
# MA 02110-1301, USA.
#
#
# TODO: refactor servo ids to represent servo objects themselves
from adafruit_servokit import ServoKit
import time
import sys
import RPi.GPIO as GPIO
# GPIO outputs for flywheel operation
pin_forward = 26
pin_backward = 20
# GPIO setup
mode=GPIO.getmode()
GPIO.cleanup()
GPIO.setmode(GPIO.BCM)
GPIO.setup(pin_forward, GPIO.OUT)
GPIO.setup(pin_backward, GPIO.OUT)
# servo ids
servo_pan = 0
servo_tilt = 1 # may or may not be possible.
servo_fire = 2
kit = ServoKit(channels=16)
kit.actuation_range = 160
is_aiming = False
# reference servo angles for cycling darts
plunger_in = 135
plunger_ext = 65
class NerfTurret:
# note to self: classmethods = static methods that can also be used
# as an instance method.
@classmethod
def aim(self, angle_x):
is_aiming = True
print("aiming")
kit.servo[servo_pan].angle = angle_x
is_aiming = False
@classmethod
def fire(self):
print("firing")
kit.servo[servo_fire].angle = plunger_in
GPIO.output(pin_forward, GPIO.HIGH)
time.sleep(1.5)
kit.servo[servo_fire].angle = plunger_ext
time.sleep(0.75)
GPIO.output(pin_forward, GPIO.LOW)
kit.servo[servo_fire].angle = plunger_in
@classmethod
def resetAngle(self):
print("resetting")
kit.servo[servo_pan].angle = 90
kit.servo[servo_fire].angle = plunger_in
@classmethod
def currentlyAiming(self):
print("Aiming status: ", is_aiming)
return is_aiming