rx: initial commit with udp
This commit is contained in:
commit
1df647198b
12 changed files with 414 additions and 0 deletions
148
.gitignore
vendored
Normal file
148
.gitignore
vendored
Normal file
|
@ -0,0 +1,148 @@
|
|||
|
||||
# Created by https://www.gitignore.io/api/python,visualstudiocode
|
||||
# Edit at https://www.gitignore.io/?templates=python,visualstudiocode
|
||||
|
||||
### Python ###
|
||||
# Byte-compiled / optimized / DLL files
|
||||
__pycache__/
|
||||
*.py[cod]
|
||||
*$py.class
|
||||
|
||||
# C extensions
|
||||
*.so
|
||||
|
||||
# Distribution / packaging
|
||||
.Python
|
||||
build/
|
||||
develop-eggs/
|
||||
dist/
|
||||
downloads/
|
||||
eggs/
|
||||
.eggs/
|
||||
lib/
|
||||
lib64/
|
||||
parts/
|
||||
sdist/
|
||||
var/
|
||||
wheels/
|
||||
pip-wheel-metadata/
|
||||
share/python-wheels/
|
||||
*.egg-info/
|
||||
.installed.cfg
|
||||
*.egg
|
||||
MANIFEST
|
||||
|
||||
# PyInstaller
|
||||
# Usually these files are written by a python script from a template
|
||||
# before PyInstaller builds the exe, so as to inject date/other infos into it.
|
||||
*.manifest
|
||||
*.spec
|
||||
|
||||
# Installer logs
|
||||
pip-log.txt
|
||||
pip-delete-this-directory.txt
|
||||
|
||||
# Unit test / coverage reports
|
||||
htmlcov/
|
||||
.tox/
|
||||
.nox/
|
||||
.coverage
|
||||
.coverage.*
|
||||
.cache
|
||||
nosetests.xml
|
||||
coverage.xml
|
||||
*.cover
|
||||
.hypothesis/
|
||||
.pytest_cache/
|
||||
|
||||
# Translations
|
||||
*.mo
|
||||
*.pot
|
||||
|
||||
# Django stuff:
|
||||
*.log
|
||||
local_settings.py
|
||||
db.sqlite3
|
||||
db.sqlite3-journal
|
||||
|
||||
# Flask stuff:
|
||||
instance/
|
||||
.webassets-cache
|
||||
|
||||
# Scrapy stuff:
|
||||
.scrapy
|
||||
|
||||
# Sphinx documentation
|
||||
docs/_build/
|
||||
|
||||
# PyBuilder
|
||||
target/
|
||||
|
||||
# Jupyter Notebook
|
||||
.ipynb_checkpoints
|
||||
|
||||
# IPython
|
||||
profile_default/
|
||||
ipython_config.py
|
||||
|
||||
# pyenv
|
||||
.python-version
|
||||
|
||||
# pipenv
|
||||
# According to pypa/pipenv#598, it is recommended to include Pipfile.lock in version control.
|
||||
# However, in case of collaboration, if having platform-specific dependencies or dependencies
|
||||
# having no cross-platform support, pipenv may install dependencies that don't work, or not
|
||||
# install all needed dependencies.
|
||||
#Pipfile.lock
|
||||
|
||||
# celery beat schedule file
|
||||
celerybeat-schedule
|
||||
|
||||
# SageMath parsed files
|
||||
*.sage.py
|
||||
|
||||
# Environments
|
||||
.env
|
||||
.venv
|
||||
env/
|
||||
venv/
|
||||
ENV/
|
||||
env.bak/
|
||||
venv.bak/
|
||||
|
||||
# Spyder project settings
|
||||
.spyderproject
|
||||
.spyproject
|
||||
|
||||
# Rope project settings
|
||||
.ropeproject
|
||||
|
||||
# mkdocs documentation
|
||||
/site
|
||||
|
||||
# mypy
|
||||
.mypy_cache/
|
||||
.dmypy.json
|
||||
dmypy.json
|
||||
|
||||
# Pyre type checker
|
||||
.pyre/
|
||||
|
||||
### VisualStudioCode ###
|
||||
.vscode/*
|
||||
!.vscode/settings.json
|
||||
!.vscode/tasks.json
|
||||
!.vscode/launch.json
|
||||
!.vscode/extensions.json
|
||||
|
||||
### VisualStudioCode Patch ###
|
||||
# Ignore all local history of files
|
||||
.history
|
||||
|
||||
# End of https://www.gitignore.io/api/python,visualstudiocode
|
||||
|
||||
### Micropy Cli ###
|
||||
.micropy/
|
||||
!micropy.json
|
||||
!src/lib
|
||||
credentials.py
|
22
.pylintrc
Normal file
22
.pylintrc
Normal file
|
@ -0,0 +1,22 @@
|
|||
[MASTER]
|
||||
# Loaded Stubs: esp8266-micropython-1.11.0
|
||||
init-hook='import sys;sys.path[1:1]=["src/lib",".micropy/BradenM-micropy-stubs-c89b5ef/frozen", ".micropy/BradenM-micropy-stubs-e1b8ce6/frozen", ".micropy/BradenM-micropy-stubs-c89b5ef/stubs", ".micropy/uc-wifi-rx-udp", ]'
|
||||
|
||||
[MESSAGES CONTROL]
|
||||
# Only show warnings with the listed confidence levels. Leave empty to show
|
||||
# all. Valid levels: HIGH, INFERENCE, INFERENCE_FAILURE, UNDEFINED.
|
||||
confidence=
|
||||
|
||||
# Disable the message, report, category or checker with the given id(s). You
|
||||
# can either give multiple identifiers separated by comma (,) or put this
|
||||
# option multiple times (only on the command line, not in the configuration
|
||||
# file where it should appear only once). You can also use "--disable=all" to
|
||||
# disable everything first and then reenable specific checks. For example, if
|
||||
# you want to run only the similarities checker, you can use "--disable=all
|
||||
# --enable=similarities". If you want to run only the classes checker, but have
|
||||
# no Warning level messages displayed, use "--disable=all --enable=classes
|
||||
# --disable=W".
|
||||
|
||||
disable = missing-docstring, line-too-long, trailing-newlines, broad-except, logging-format-interpolation, invalid-name, empty-docstring,
|
||||
no-method-argument, assignment-from-no-return, too-many-function-args, unexpected-keyword-arg
|
||||
# the 2nd line deals with the limited information in the generated stubs.
|
3
README.md
Normal file
3
README.md
Normal file
|
@ -0,0 +1,3 @@
|
|||
# uc-wifi-rx-udp
|
||||
|
||||
control two motors with a L298N and receive commands via udp
|
1
dev-requirements.txt
Normal file
1
dev-requirements.txt
Normal file
|
@ -0,0 +1 @@
|
|||
micropy-cli
|
14
micropy.json
Normal file
14
micropy.json
Normal file
|
@ -0,0 +1,14 @@
|
|||
{
|
||||
"name": "uc-wifi-rx-udp",
|
||||
"stubs": {
|
||||
"esp8266-micropython-1.11.0": "1.2.0"
|
||||
},
|
||||
"dev-packages": {
|
||||
"micropy-cli": "*"
|
||||
},
|
||||
"packages": {},
|
||||
"config": {
|
||||
"vscode": true,
|
||||
"pylint": true
|
||||
}
|
||||
}
|
21
pymakr.conf
Normal file
21
pymakr.conf
Normal file
|
@ -0,0 +1,21 @@
|
|||
{
|
||||
"address": "/dev/esp-rx",
|
||||
"username": "micro",
|
||||
"password": "python",
|
||||
"sync_folder": "src",
|
||||
"open_on_start": true,
|
||||
"safe_boot_on_upload": false,
|
||||
"py_ignore": [
|
||||
"pymakr.conf",
|
||||
".vscode",
|
||||
".gitignore",
|
||||
".git",
|
||||
"project.pymakr",
|
||||
"env",
|
||||
"venv",
|
||||
".python-version",
|
||||
".micropy/",
|
||||
"micropy.json"
|
||||
],
|
||||
"fast_upload": true
|
||||
}
|
0
requirements.txt
Normal file
0
requirements.txt
Normal file
1
src/boot.py
Normal file
1
src/boot.py
Normal file
|
@ -0,0 +1 @@
|
|||
# boot.py - - runs on boot-up
|
51
src/esc.py
Normal file
51
src/esc.py
Normal file
|
@ -0,0 +1,51 @@
|
|||
from motor import Motor
|
||||
from time import sleep
|
||||
|
||||
delta = 10
|
||||
|
||||
class Esc:
|
||||
def __init__(self, pin_m1_ena, pin_m1_in1, pin_m1_in2,
|
||||
pin_m2_ena, pin_m2_in1, pin_m2_in2):
|
||||
self.m1 = Motor("m1", pin_m1_ena, pin_m1_in1, pin_m1_in2)
|
||||
self.m2 = Motor("m2", pin_m2_ena, pin_m2_in1, pin_m2_in2)
|
||||
|
||||
def fwd(self):
|
||||
speed = min((self.m1.speed + self.m2.speed)/2 + delta, 100)
|
||||
self.m1.set_speed(speed)
|
||||
self.m2.set_speed(speed)
|
||||
|
||||
def rev(self):
|
||||
speed = max((self.m1.speed + self.m2.speed)/2 - delta, -100)
|
||||
self.m1.set_speed(speed)
|
||||
self.m2.set_speed(speed)
|
||||
|
||||
def left(self):
|
||||
self.m1.dec(delta)
|
||||
self.m2.inc(delta)
|
||||
|
||||
def right(self):
|
||||
self.m1.inc(delta)
|
||||
self.m2.dec(delta)
|
||||
|
||||
# stop
|
||||
def b1(self):
|
||||
self.m1.set_speed(0)
|
||||
self.m2.set_speed(0)
|
||||
|
||||
def b2(self):
|
||||
if self.m1.speed >= 0:
|
||||
self.m1.set_speed(0)
|
||||
self.m2.set_speed(0)
|
||||
sleep(1)
|
||||
self.m1.set_speed(-50)
|
||||
self.m2.set_speed(50)
|
||||
else:
|
||||
self.m1.set_speed(0)
|
||||
self.m2.set_speed(0)
|
||||
sleep(1)
|
||||
self.m1.set_speed(50)
|
||||
self.m2.set_speed(-50)
|
||||
|
||||
def get_status(self):
|
||||
s = (self.m1.get_status(), self.m2.get_status())
|
||||
return s
|
69
src/main.py
Normal file
69
src/main.py
Normal file
|
@ -0,0 +1,69 @@
|
|||
# main.py
|
||||
import machine
|
||||
import usocket as socket
|
||||
from time import sleep
|
||||
from esc import Esc
|
||||
from wifi import WifiAP
|
||||
from wifi import WifiSTA
|
||||
# import web
|
||||
|
||||
PIN_M1_ENA = 5 # D1
|
||||
PIN_M1_IN1 = 4 # D2
|
||||
PIN_M1_IN2 = 0 # D3
|
||||
PIN_M2_IN1 = 12 # D6
|
||||
PIN_M2_IN2 = 13 # D7
|
||||
PIN_M2_ENA = 15 # D8
|
||||
|
||||
esc = None
|
||||
|
||||
def main():
|
||||
print("main")
|
||||
global esc
|
||||
wifi_sta = WifiSTA()
|
||||
# wifi_ap = WifiAP()
|
||||
esc = Esc(PIN_M1_ENA, PIN_M1_IN1, PIN_M1_IN2,
|
||||
PIN_M2_ENA, PIN_M2_IN1, PIN_M2_IN2)
|
||||
s = socket.socket(socket.AF_INET, socket.SOCK_DGRAM)
|
||||
s.setsockopt(socket.SOL_SOCKET,socket.SO_REUSEADDR, 1)
|
||||
s.bind(("", 80))
|
||||
|
||||
while True:
|
||||
request = ""
|
||||
try:
|
||||
request, addr = s.recvfrom(256)
|
||||
req = request.decode()
|
||||
|
||||
print("data: {}, from: {}".format(req, addr))
|
||||
if len(request) == 0:
|
||||
print("no data")
|
||||
continue
|
||||
except:
|
||||
print("error: no data")
|
||||
pass
|
||||
|
||||
if "fwd" in req:
|
||||
print("--> fwd")
|
||||
esc.fwd()
|
||||
|
||||
elif "left" in req:
|
||||
print("--> left")
|
||||
esc.left()
|
||||
|
||||
elif "rev" in req:
|
||||
print("--> rev")
|
||||
esc.rev()
|
||||
|
||||
elif "right" in req:
|
||||
print("--> right")
|
||||
esc.right()
|
||||
|
||||
elif "b1" in req:
|
||||
print("--> b1")
|
||||
esc.b1()
|
||||
|
||||
elif "b2" in req:
|
||||
print("--> b2")
|
||||
esc.b2()
|
||||
|
||||
if __name__ == "__main__":
|
||||
main()
|
53
src/motor.py
Normal file
53
src/motor.py
Normal file
|
@ -0,0 +1,53 @@
|
|||
import machine
|
||||
from time import sleep
|
||||
|
||||
|
||||
class Motor:
|
||||
PWM_MAX = 1023
|
||||
DIR_FWD = 1
|
||||
DIR_REV = 0
|
||||
|
||||
def __init__(self, name, ena, p1, p2):
|
||||
self.name = name
|
||||
self.pin1 = machine.Pin(p1, machine.Pin.OUT)
|
||||
self.pin2 = machine.Pin(p2, machine.Pin.OUT)
|
||||
self.pwm = machine.PWM(machine.Pin(ena, machine.Pin.OUT))
|
||||
self.pwm.freq(1000)
|
||||
# state
|
||||
self.dir = -1
|
||||
self.speed = -1
|
||||
sleep(1)
|
||||
# initialize motors
|
||||
self.set_speed(0)
|
||||
print(self.get_status())
|
||||
|
||||
def get_status(self):
|
||||
s = "[{}:status] pins {},{} duty {}".format(self.name, self.pin1.value(), self.pin2.value(), self.pwm.duty())
|
||||
return s
|
||||
|
||||
def set_dir(self, dir):
|
||||
if self.dir == dir:
|
||||
return
|
||||
self.dir = dir
|
||||
v1 = 1 if dir == self.DIR_FWD else 0
|
||||
v2 = 0 if dir == self.DIR_FWD else 1
|
||||
self.pin1.value(v1)
|
||||
self.pin2.value(v2)
|
||||
|
||||
def set_speed(self, speed=100):
|
||||
print("[{}:set_speed] {} [-100:100]".format(self.name, speed))
|
||||
if speed < 0:
|
||||
self.set_dir(self.DIR_REV)
|
||||
else:
|
||||
self.set_dir(self.DIR_FWD)
|
||||
self.speed = speed
|
||||
s = int(self.PWM_MAX * abs(speed)/100)
|
||||
self.pwm.duty(s)
|
||||
|
||||
def inc(self, delta):
|
||||
speed = min(self.speed + delta, 100)
|
||||
self.set_speed(speed)
|
||||
|
||||
def dec(self, delta):
|
||||
speed = max(self.speed - delta, -100)
|
||||
self.set_speed(speed)
|
31
src/wifi.py
Normal file
31
src/wifi.py
Normal file
|
@ -0,0 +1,31 @@
|
|||
from credentials import *
|
||||
import network
|
||||
import time
|
||||
|
||||
address = "192.168.0.1"
|
||||
netmask = "255.255.255.0"
|
||||
gateway = "192.168.0.1"
|
||||
dns = "192.168.0.1"
|
||||
|
||||
if_ap = network.WLAN(network.AP_IF)
|
||||
if_sta = network.WLAN(network.STA_IF)
|
||||
|
||||
class WifiAP:
|
||||
def __init__(self):
|
||||
global if_ap, if_sta
|
||||
if_sta.active(False)
|
||||
if_ap.active(True)
|
||||
if_ap.ifconfig([address, netmask, gateway, dns])
|
||||
if_ap.config(essid=SSID, password=PASS)
|
||||
print("network config {}".format(if_ap.ifconfig()))
|
||||
|
||||
class WifiSTA:
|
||||
def __init__(self):
|
||||
global if_ap, if_sta
|
||||
if_ap.active(False)
|
||||
if_sta.active(True)
|
||||
if_sta.connect(SSID, PASS)
|
||||
while not if_sta.isconnected():
|
||||
pass
|
||||
time.sleep(0.1)
|
||||
print("network config {}".format(if_sta.ifconfig()))
|
Loading…
Reference in a new issue