-
Notifications
You must be signed in to change notification settings - Fork 0
/
servobot.py
143 lines (106 loc) · 3.9 KB
/
servobot.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
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
#!/usr/bin/env python
import telegram
import logging
import acmepins as GPIO
import time
import os
token_string="144698784:AAFiwSmBktYVu5VmSTF35aQ4zgC3RvVhK9M"
welcome_text = "Arietta G25 with Servo !\n"
menu_keyboard = telegram.ReplyKeyboardMarkup([['RED ON','YELLOW ON','GREEN ON'],['RED OFF','YELLOW OFF','GREEN OFF'],['LEFT',"CENTER","RIGHT"]])
menu_keyboard.one_time_keyboard=False
menu_keyboard.resize_keyboard=True
# Enable logging
logging.basicConfig(
format='%(asctime)s - %(name)s - %(levelname)s - %(message)s',
level=logging.INFO)
logger = logging.getLogger(__name__)
def start(bot, update):
bot.sendMessage(update.message.chat_id, welcome_text)
menu(bot,update)
def menu(bot, update):
bot.sendMessage(update.message.chat_id, text="Seleziona un comando", reply_markup=menu_keyboard)
def send_stop(bot, update):
reply_markup = telegram.ReplyKeyboardHide()
bot.sendMessage(update.message.chat_id, text="Bye", reply_markup=reply_markup)
def echo(bot, update):
print "----> Mittente: : [" + update.message.from_user.username + "]"
print " Testo : [" + update.message.text + "]"
if update.message.text:
if update.message.text=="RED ON":
GPIO.output(RED, 1)
bot.sendMessage(update.message.chat_id, text="Led rosso ON")
if update.message.text=="RED OFF":
GPIO.output(RED, 0)
bot.sendMessage(update.message.chat_id, text="Led rosso OFF")
if update.message.text=="YELLOW ON":
GPIO.output(YELLOW,1)
bot.sendMessage(update.message.chat_id, text="Led giallo ON")
if update.message.text=="YELLOW OFF":
GPIO.output(YELLOW, 0)
bot.sendMessage(update.message.chat_id, text="Led giallo OFF")
if update.message.text=="GREEN ON":
GPIO.output(GREEN,1)
bot.sendMessage(update.message.chat_id, text="Led verde ON")
if update.message.text=="GREEN OFF":
GPIO.output(GREEN, 0)
bot.sendMessage(update.message.chat_id, text="Led verde OFF")
if update.message.text=="LEFT":
bot.sendMessage(update.message.chat_id, text="Servo a sinistra")
GPIO.pwm_duty_cycle(0,570000)
GPIO.pwm_enable(0)
time.sleep(1)
GPIO.pwm_disable(0)
if update.message.text=="CENTER":
bot.sendMessage(update.message.chat_id, text="Servo al centro")
GPIO.pwm_duty_cycle(0,1490000)
GPIO.pwm_enable(0)
time.sleep(1)
GPIO.pwm_disable(0)
if update.message.text=="RIGHT":
bot.sendMessage(update.message.chat_id, text="Servo a destra")
GPIO.pwm_duty_cycle(0,2410000)
GPIO.pwm_enable(0)
time.sleep(1)
GPIO.pwm_disable(0)
def error(bot, update, error):
logger.warn('Update "%s" caused error "%s"' % (update, error))
def main():
print "Token:" , token_string
updater = telegram.Updater(token_string)
# Get the dispatcher to register handlers
dp = updater.dispatcher
# Definisce gli handler di gestione dei comandi
dp.addTelegramCommandHandler("start", start)
dp.addTelegramCommandHandler("menu", menu)
dp.addTelegramCommandHandler("help", menu)
# on noncommand i.e message - echo the message on Telegram
dp.addTelegramMessageHandler(echo)
# log all errors
dp.addErrorHandler(error)
# Start the Bot
update_queue = updater.start_polling(poll_interval=0.1, timeout=10)
try:
# Run the bot until the you presses Ctrl-C or the process receives SIGINT,
# SIGTERM or SIGABRT. This should be used most of the time, since
# start_polling() is non-blocking and will stop the bot gracefully.
updater.idle()
except KeyboardInterrupt:
print "Exit"
GPIO.cleanup() # clean up GPIO on CTRL+C exit
GPIO.cleanup() # clean up GPIO on normal exit
if __name__ == '__main__':
#Riferimento ai GPIO per numero pin
GPIO.setmode(GPIO.BOARD)
#GPIO.setwarnings(False)
RED="J4.40"
YELLOW="J4.38"
GREEN="J4.36"
GPIO.setup(RED, GPIO.OUT)
GPIO.setup(YELLOW, GPIO.OUT)
GPIO.setup(GREEN, GPIO.OUT)
GPIO.output(RED, 0)
GPIO.output(YELLOW, 0)
GPIO.output(GREEN, 0)
GPIO.pwm_export(0)
GPIO.pwm_period(0,20000000)
main()