50 lines
6.4 KiB
Plaintext
50 lines
6.4 KiB
Plaintext
|
o
|
|||
|
|
-,8i<38> <00>
|
|||
|
|
@ sz U d dl Zd dlmZ d dlZd dlZd dlZd dlZdZej eej
|
|||
|
|
dd<05> e<04> d<06>Z de
ddfd d
|
|||
|
|
<EFBFBD>ZdaedB ed < d adGdedededB fdd<12>Zdefdd<14>Zdefdd<16>Zdefdd<18>Zdefdd<1A>Zdefdd <1C>Zd eddfd d <1F>ZdHd d!<21>Z defd"d#<23>Z de
fd$d%<25>Z e<16> \Z Z e<01>!<21> <00><01> Z"ej#d&d'd d(<28>Z$e<01>%d)<29>Z&e&j'e de$d*<2A> e<01>(d+<2B> e<01>)<29> <00><> e<01>*<2A> <00>B e<01>(d,<2C> e<01>%d-<2D>Z+e<01>%d.<2E>Z,e<01>%d/<2F>Z-ej#d0e d d1<64>Z.e+j'ede.e$gd*<2A> e,j'ede.e$gd*<2A> e-j'e de.e$gd*<2A> W d <00> n1 s<>w Y e<01>*<2A> <00>R e<01>(d2<64> ej/d d3d4d5<64>Z0ej/d d3d6d5<64>Z1ej/d d3d7d5<64>Z2ej/d d3d8d5<64>Z3ej/d9dd:d9d;d<<3C>Z4e<01>%d=<3D>Z5ej#d>d d?<3F>Z6e5j'ee0e1e2e3e4ge6e$gd*<2A> W d <00> n 1 <00>s]w Y e<01>*<2A> <00># e<01>(d@<40> ej#dAd d?<3F>Z7e<01>%dB<64>Z8e8j'ede7e$gd*<2A> W d <00> n 1 <00>s<>w Y W d <00> n 1 <00>s<>w Y e"j9dCdDdEdF<64> W d <00> dS 1 <00>s<>w Y dS )I<> N)<01>BalanceControllerzui.logz)%(asctime)s - %(levelname)s - %(message)s)<03>filename<6D>level<65>formatZui<75>msg<73>returnc C s* t <00>| <00> t jD ]}|<01><03> qt| <00> dS )uK 统一写入日志的函数，同时打印到控制台（方便调试）。N)<05>logger<65>info<66>handlers<72>flush<73>print)r <00>h<> r <00>main.py<70>log s
|
|||
|
|
|
|||
|
|
|
|||
|
|
r <00>
|
|||
|
|
controllerF<EFBFBD> <00> <00>?<3F>retries<65>delayc C s<> t d| d <00>D ]2}ztd|<02> d<03><03> t<02> W S ty9 } ztd|<03> <00><02> || k r/t<04>|<01> W Y d}~qd}~ww td<06> dS )uJ 尝试实例化 BalanceController，失败则记录日志并返回 None。<65> u% 尝试创建 BalanceController（第 u 次）u! 创建 BalanceController 失败: Nu6 全部重试结束，仍未能创建 BalanceController)<06>ranger r <00> Exception<6F>time<6D>sleep)r r Zattempt<70>er r r <00>create_controller# s
|
|||
|
|
<14><02>r c C sR t du r t<01> a t du rd} t| <00> | | fS d} t| <00> | | fS d} t| <00> | | fS )uF 创建 BalanceController 实例并打开串口（不自动使能）。Nu3 打开串口失败：无法创建 BalanceControlleru 串口已打开u$ 串口已打开（已存在实例）)r r r <00>r r r r <00> open_port3 s r c
|
|||
|
|
C <00>v t du r
|
|||
|
|
d} | | fS zt <00><01> dad} t| <00> | | fW S ty: } zd|<01> <00>} t| <00> | | fW Y d}~S d}~ww )u( 使能所有电机（腿部+轮子）。N<E38082> 请先打开串口Tu 电机已全部使能u 使能电机异常: )r <00>
|
|||
|
|
enable_all<EFBFBD>motors_enabledr r <00>r r r r r r! C <00>
|
|||
|
|
|
|||
|
|
<08><02>r! c
|
|||
|
|
C r )u 失能所有电机。Nr Fu 所有电机已失能u 失能电机异常: )r <00> disable_allr" r r r# r r r r% T r$ r% c C s<> t du r
|
|||
|
|
d}||fS z$t <00>| ||||<04> d| <00> d|<01> d|<02> d|<03> d|<04> d<06> }t|<05> ||fW S tyM } zd|<06> <00>}t|<05> ||fW Y d}~S d}~ww )u* 设置四条腿的位置与速度比例。Nr u 已设置位置: z, u （速度比例 u ）u 设置位置异常: )r Zcontrol_legs_posr r )<07>pos1<73>pos2<73>pos3<73>pos4<73>velr r r r r <00> set_positione s $
|
|||
|
|
|
|||
|
|
<08><02>r+ c
|
|||
|
|
C s<> t du rd} t| <00> dgd | fS zt <00><02> }d|<01> <00>} t| <00> dd<06> |D <00>| fW S tyJ } zd|<02> <00>} t| <00> dgd | fW Y d}~S d}~ww ) u3 读取四条腿的扭矩，返回字符串列表。Nu 未打开串口<E4B8B2> u 读取扭矩: c S s g | ] }|d ur |d<01>nd<02>qS )Nz.2fzN/Ar )<02>.0<EFBFBD>tr r r <00>
|
|||
|
|
<listcomp>~ s z get_torque.<locals>.<listcomp>u 读取扭矩异常: u 错误)r r Zget_legs_torquer )r Ztorquesr r r r <00>
|
|||
|
|
get_torquet s
|
|||
|
|
|
|||
|
|
<08><02>r0 <00>ctrlc
|
|||
|
|
C s<> z>z| <00> <00> td<01> | <00><02> W n ty( } z
td|<01> <00><02> W Y d}~nd}~ww W | <00><04> td<04> dS W | <00><04> td<04> dS | <00><04> td<04> w )uE 后台线程入口，运行平衡循环并确保资源安全释放。u 平衡循环启动u 平衡循环异常: Nu' 平衡循环已结束，资源已清理)r! r Zrun_balance_loopr Zshutdown)r1 r r r r <00>_balance_thread<61> s <08><02><02> <02> <08>
|
|||
|
|
r2 c C sH t du rt<01> a t du rtd<02> dS tjtt fdd<04>} | <00><06> td<05> dS )u' 在守护线程中启动平衡循环。Nu9 启动平衡控制失败：无法创建 BalanceControllerT)<03>target<65>argsZdaemonu 平衡控制线程已启动)r r r <00> threadingZThreadr2 <00>start)<01>threadr r r <00>start_balance_thread<61> s r8 c C s2 t s d} t| <00> | | fS t<02> d} t| <00> | | fS )u3 检查电机是否已使能后启动平衡控制。u* 启动平衡控制失败：电机未使能u 平衡控制已启动)r" r r8 r r r r <00>
start_balance<63> s r9 c C sJ t j<01>t<03>sdS ttddd<04><03> } | <00><05> W d <00> S 1 s w Y dS )u0 读取最新的日志文件内容返回给 UI。<49> <00>rzutf-8)<01>encodingN)<06>os<6F>path<74>exists<74>LOG_PATH<54>open<65>read)<01>fr r r <00> refresh_log<6F> s
|
|||
|
|
$<24>rD u 运行日志<E697A5> )<03>label<65>lines<65> interactiveu 刷新日志)<03>fnZinputsZoutputsu" # 🤖 四足机器人控制面板u ## 电机控制u ✅ 使能全部u ❌ 失能全部u ▶️ 启动平衡控制u 状态)rF <00>valuerH u ## 位置控制g333333<33>?u 腿 1 位置)rF u 腿 2 位置u 腿 3 位置u 腿 4 位置g<E7BDAE><67><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>?g <00>?u 速度比例)rJ <00>steprF u 📍 设置位置u 位置设置结果)rF rH u ## 扭矩读取u 腿部扭矩 (N/m)u 🔍 读取扭矩z0.0.0.0i<EFBFBD> T)Z server_nameZ server_port<72>debug)r r )r N):ZgradioZgr<67>balancer Zloggingr5 r r= r@ Z basicConfig<69>INFOZ getLoggerr <00>strr r <00>__annotations__r" <00>int<6E>floatr <00>tupler r! r% r+ r0 r2 r8 r9 rD Z init_status<75>_ZBlocksZdemoZTextboxZlog_boxZButtonZ refresh_btnZclickZMarkdownZRowZColumnZ
|
|||
|
|
enable_btnZ disable_btnZ start_btnZ
|
|||
|
|
status_boxZSliderr& r' r( r) r* Zset_btnZ
|
|||
|
|
pos_statusZ
torque_outputZread_btnZlaunchr r r r <00><module> s<>
|
|||
|
|
<06>
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
<1C>
|
|||
|
|
|
|||
|
|
|
|||
|
|
<08> <1E>
|
|||
|
|
|
|||
|
|
|
|||
|
|
<1E><02> <1E>$$<24>
|