这个提交包含在:
2025-09-19 18:02:06 +08:00
父节点 7d3206cfc8
当前提交 c189022db4
共有 3 个文件被更改,包括 71 次插入 和 0 次删除

5
README.MD 普通文件
查看文件

@ -0,0 +1,5 @@
# 机械臂控制模块
## 目录
- `server` LeRobot兼容的服务器端
- `keyboard` 键盘操纵

66
server/main.py 普通文件
查看文件

@ -0,0 +1,66 @@
import EZArm
EAC = EZArm.EZArmConfig("/dev/i2c-1",id="EZArm0")
Arm = EZArm.EZArm(EAC)
from datetime import datetime
import fastapi
import uvicorn
from starlette.websockets import WebSocket
def debug_log(msg, logger ="TEST"):
dt = datetime.now().strftime('%Y%m%d %H:%M:%S')
print(f"[{dt}]|[{logger}]|{msg}")
try:
with open("./log", "a") as f:
print(f"[{dt}]|[{logger}]|{msg}", file=f)
f.close()
except FileNotFoundError:
with open("./log", "w") as f:
print(f"[{dt}]|[{logger}]|{msg}", file=f)
f.close()
debug_log('Server Has Started',"SYSTEM")
class ConnectionManager:
def __init__(self):
self.active_connections: list[WebSocket] = []
async def connect(self, websocket: WebSocket):
await websocket.accept()
self.active_connections.append(websocket)
def disconnect(self, websocket: WebSocket):
self.active_connections.remove(websocket)
async def send_personal_message(self, message: str, websocket: WebSocket):
await websocket.send_text(message)
async def broadcast(self, message: str):
for connection in self.active_connections:
await connection.send_text(message)
App = fastapi.FastAPI()
manager = ConnectionManager()
@App.websocket('/ws')
async def websocket_handler(websocket: fastapi.WebSocket):
await manager.connect(websocket)
try:
while True:
message = await websocket.receive_json()
debug_log(message,'WebSocket')
print(message['id'])
print(message['val'])
Arm.send_action({
message['id']:message['val']
})
except fastapi.WebSocketDisconnect:
manager.disconnect(websocket)
if __name__ == '__main__':
uvicorn.run(App, port=8989, host='0.0.0.0')