forked from erlerobot/erle_control
/
init_motors.py
60 lines (43 loc) · 1 KB
/
init_motors.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
#!/usr/bin/env python
# -*- encoding: utf-8 -*-
'''
_____ _ _____ _ _
| __|___| |___ | __ |___| |_ ___| |_
| __| _| | -_| | -| . | . | . | _|
|_____|_| |_|___| |__|__|___|___|___|_|
@author: Víctor Mayoral Vilches <victor@erlerobot.com>
@description: ESC initialization
@brief init the ESCs. Tested with SiLabs ESCs
'''
from motors import Motor
import Adafruit_BBIO.GPIO as GPIO
import time
import os
def initMotors():
speed = 10
m1 = Motor(1);
m1.setSpeedBrushless(speed)
m1.go()
m2 = Motor(2);
m2.setSpeedBrushless(speed);
m2.go()
m3 = Motor(3);
m3.setSpeedBrushless(speed);
m3.go()
m4 = Motor(4);
m4.setSpeedBrushless(speed);
m4.go()
time.sleep(0.5)
#####
# shutdown the motors
#####
speed = 0
m1.setSpeedBrushless(speed);
m1.go()
m2.setSpeedBrushless(speed);
m2.go()
m3.setSpeedBrushless(speed);
m3.go()
m4.setSpeedBrushless(speed);
m4.go()
initMotors()