webui恢复直线mm控制
This commit is contained in:
1 parent
48dfbeedea
commit
f96e72dbb8
2 files changed
+380
-11
No files matched your search
@@ -51,6 +51,9 @@ void actuator_init(void)
|
|||||||
/* 配置舵机限位: 抬起=80°, 放下=160° */
|
/* 配置舵机限位: 抬起=80°, 放下=160° */
|
||||||
servo_set_limits(80.0f, 160.0f);
|
servo_set_limits(80.0f, 160.0f);
|
||||||
|
|
||||||
|
/* 上电默认归位到抬起状态 */
|
||||||
|
servo_set_up();
|
||||||
|
|
||||||
/* 配置 4 路电机: 闭环位置模式 + 使能 */
|
/* 配置 4 路电机: 闭环位置模式 + 使能 */
|
||||||
const uint8_t addrs[] = {
|
const uint8_t addrs[] = {
|
||||||
ACTUATOR_ADDR_ANGLE, ACTUATOR_ADDR_X,
|
ACTUATOR_ADDR_ANGLE, ACTUATOR_ADDR_X,
|
||||||
|
|||||||
+377
-11
@@ -8,6 +8,7 @@
|
|||||||
#include "magnet.h"
|
#include "magnet.h"
|
||||||
#include "servo.h"
|
#include "servo.h"
|
||||||
#include "protocol.h"
|
#include "protocol.h"
|
||||||
|
#include "actuator.h"
|
||||||
|
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
#include <stdlib.h>
|
#include <stdlib.h>
|
||||||
@@ -118,37 +119,64 @@ button:active{opacity:.7}
|
|||||||
<div class="grid">
|
<div class="grid">
|
||||||
|
|
||||||
<div class="card">
|
<div class="card">
|
||||||
<h2><i class="tag"></i>电机使能</h2>
|
<h2><i class="tag green"></i>轴控制 (XYZA)</h2>
|
||||||
<div class="row"><label>地址</label><input id="en_addr" type="number" value="1" min="1" max="247"></div>
|
<div class="row"><label>X mm</label><input id="ax_x" type="number" value="0" min="0" max="210" step="0.1"><span class="unit">→电机2 (CW) 0~210</span></div>
|
||||||
|
<div class="row"><label>Y mm</label><input id="ax_y" type="number" value="0" min="0" max="335" step="0.1"><span class="unit">→电机3+4 (CCW) 0~335</span></div>
|
||||||
|
<div class="row"><label>Z °</label><input id="ax_zrot" type="number" value="0" step="0.1"><span class="unit">→电机1 (±: CW/CCW)</span></div>
|
||||||
|
<div class="row"><label>舵机</label><input id="ax_servo" type="number" value="90" min="0" max="180" step="0.5"><span class="unit">°</span></div>
|
||||||
|
<div class="row"><label>速度</label><input id="ax_vel" type="number" value="500" min="0" max="5000"><span class="unit">RPM</span></div>
|
||||||
|
<div class="row"><label>加速度</label><input id="ax_acc" type="number" value="50" min="0" max="255"></div>
|
||||||
<div class="btn-row">
|
<div class="btn-row">
|
||||||
<button class="btn-on" onclick="api('enable?addr='+v('en_addr')+'&state=1')">使能</button>
|
<button class="btn-go" onclick="axisMove()">移动到目标</button>
|
||||||
<button class="btn-off" onclick="api('enable?addr='+v('en_addr')+'&state=0')">关闭</button>
|
<button class="btn-stop" onclick="api('stop?addr=1');api('stop?addr=2');api('stop?addr=3');api('stop?addr=4')">急停全部</button>
|
||||||
|
</div>
|
||||||
|
</div>
|
||||||
|
|
||||||
|
<div class="card">
|
||||||
|
<h2><i class="tag"></i>电机使能</h2>
|
||||||
|
<div class="row"><label>地址</label><input id="en_addr" type="text" value="1" placeholder="1|2|3|4"></div>
|
||||||
|
<div class="btn-row">
|
||||||
|
<button class="btn-on" onclick="apiEach('enable','en_addr','&state=1')">使能</button>
|
||||||
|
<button class="btn-off" onclick="apiEach('enable','en_addr','&state=0')">关闭</button>
|
||||||
</div>
|
</div>
|
||||||
</div>
|
</div>
|
||||||
|
|
||||||
<div class="card">
|
<div class="card">
|
||||||
<h2><i class="tag"></i>速度模式</h2>
|
<h2><i class="tag"></i>速度模式</h2>
|
||||||
<div class="row"><label>地址</label><input id="v_addr" type="number" value="1" min="1" max="247"></div>
|
<div class="row"><label>地址</label><input id="v_addr" type="text" value="1" placeholder="1|2|3|4"></div>
|
||||||
<div class="row"><label>方向</label><select id="v_dir"><option value="0">CW 正转</option><option value="1">CCW 反转</option></select></div>
|
<div class="row"><label>方向</label><select id="v_dir"><option value="0">CW 正转</option><option value="1">CCW 反转</option></select></div>
|
||||||
<div class="row"><label>速度</label><input id="v_vel" type="number" value="100" min="0" max="5000"><span class="unit">RPM</span></div>
|
<div class="row"><label>速度</label><input id="v_vel" type="number" value="100" min="0" max="5000"><span class="unit">RPM</span></div>
|
||||||
<div class="row"><label>加速度</label><input id="v_acc" type="number" value="10" min="0" max="255"></div>
|
<div class="row"><label>加速度</label><input id="v_acc" type="number" value="10" min="0" max="255"></div>
|
||||||
<div class="btn-row">
|
<div class="btn-row">
|
||||||
<button class="btn-go" onclick="api('velocity?addr='+v('v_addr')+'&dir='+v('v_dir')+'&vel='+v('v_vel')+'&acc='+v('v_acc'))">启动</button>
|
<button class="btn-go" onclick="apiEach('velocity','v_addr','&dir='+v('v_dir')+'&vel='+v('v_vel')+'&acc='+v('v_acc'))">启动</button>
|
||||||
<button class="btn-stop" onclick="api('stop?addr='+v('v_addr'))">停止</button>
|
<button class="btn-stop" onclick="apiEach('stop','v_addr','')">停止</button>
|
||||||
</div>
|
</div>
|
||||||
</div>
|
</div>
|
||||||
|
|
||||||
<div class="card">
|
<div class="card">
|
||||||
<h2><i class="tag"></i>位置模式</h2>
|
<h2><i class="tag"></i>位置模式</h2>
|
||||||
<div class="row"><label>地址</label><input id="p_addr" type="number" value="1" min="1" max="247"></div>
|
<div class="row"><label>地址</label><input id="p_addr" type="text" value="1" placeholder="1|2|3|4"></div>
|
||||||
<div class="row"><label>方向</label><select id="p_dir"><option value="0">CW 正转</option><option value="1">CCW 反转</option></select></div>
|
<div class="row"><label>方向</label><select id="p_dir"><option value="0">CW 正转</option><option value="1">CCW 反转</option></select></div>
|
||||||
<div class="row"><label>速度</label><input id="p_vel" type="number" value="100" min="0" max="5000"><span class="unit">RPM</span></div>
|
<div class="row"><label>速度</label><input id="p_vel" type="number" value="100" min="0" max="5000"><span class="unit">RPM</span></div>
|
||||||
<div class="row"><label>加速度</label><input id="p_acc" type="number" value="10" min="0" max="255"></div>
|
<div class="row"><label>加速度</label><input id="p_acc" type="number" value="10" min="0" max="255"></div>
|
||||||
<div class="row"><label>脉冲数</label><input id="p_clk" type="number" value="2000" min="0"></div>
|
<div class="row"><label>脉冲数</label><input id="p_clk" type="number" value="2000" min="0"></div>
|
||||||
<div class="row"><label>模式</label><select id="p_raf"><option value="0">相对运动</option><option value="1">绝对运动</option></select></div>
|
<div class="row"><label>模式</label><select id="p_raf"><option value="0">相对运动</option><option value="1">绝对运动</option></select></div>
|
||||||
<div class="btn-row">
|
<div class="btn-row">
|
||||||
<button class="btn-go" onclick="api('position?addr='+v('p_addr')+'&dir='+v('p_dir')+'&vel='+v('p_vel')+'&acc='+v('p_acc')+'&clk='+v('p_clk')+'&raf='+v('p_raf'))">启动</button>
|
<button class="btn-go" onclick="apiEach('position','p_addr','&dir='+v('p_dir')+'&vel='+v('p_vel')+'&acc='+v('p_acc')+'&clk='+v('p_clk')+'&raf='+v('p_raf'))">启动</button>
|
||||||
<button class="btn-stop" onclick="api('stop?addr='+v('p_addr'))">停止</button>
|
<button class="btn-stop" onclick="apiEach('stop','p_addr','')">停止</button>
|
||||||
|
</div>
|
||||||
|
</div>
|
||||||
|
|
||||||
|
<div class="card">
|
||||||
|
<h2><i class="tag"></i>角度控制</h2>
|
||||||
|
<div class="row"><label>地址</label><input id="ag_addr" type="text" value="1" placeholder="1|2|3|4"></div>
|
||||||
|
<div class="row"><label>角度</label><input id="ag_angle" type="number" value="0" step="0.1"><span class="unit">°</span></div>
|
||||||
|
<div class="row"><label>速度</label><input id="ag_vel" type="number" value="500" min="0" max="5000"><span class="unit">RPM</span></div>
|
||||||
|
<div class="row"><label>加速度</label><input id="ag_acc" type="number" value="50" min="0" max="255"></div>
|
||||||
|
<div class="row"><label>模式</label><select id="ag_raf"><option value="0">相对运动</option><option value="1">绝对运动</option></select></div>
|
||||||
|
<div class="btn-row">
|
||||||
|
<button class="btn-go" onclick="apiEach('angle','ag_addr','&angle='+v('ag_angle')+'&vel='+v('ag_vel')+'&acc='+v('ag_acc')+'&raf='+v('ag_raf'))">转到角度</button>
|
||||||
|
<button class="btn-stop" onclick="apiEach('stop','ag_addr','')">停止</button>
|
||||||
</div>
|
</div>
|
||||||
</div>
|
</div>
|
||||||
|
|
||||||
@@ -174,6 +202,36 @@ button:active{opacity:.7}
|
|||||||
</div>
|
</div>
|
||||||
</div>
|
</div>
|
||||||
|
|
||||||
|
<div class="card">
|
||||||
|
<h2><i class="tag"></i>读取参数</h2>
|
||||||
|
<div class="row"><label>地址</label><input id="rp_addr" type="text" value="1" placeholder="1"></div>
|
||||||
|
<div class="row"><label>参数</label><select id="rp_param"><option value="0">固件版本</option><option value="3">总线电压</option><option value="5">相电流</option><option value="7">编码器值</option><option value="8">目标位置</option><option value="9">实时转速</option><option value="10">实时位置</option><option value="11">位置误差</option><option value="13">状态标志</option><option value="16">回零状态</option></select></div>
|
||||||
|
<button class="btn-go btn-block" onclick="readParam()">读取</button>
|
||||||
|
<div id="rp_out" style="font-size:.82rem;margin-top:8px;word-break:break-all"></div>
|
||||||
|
</div>
|
||||||
|
|
||||||
|
<div class="card">
|
||||||
|
<h2><i class="tag green"></i>回零校准 (Origin)</h2>
|
||||||
|
<div class="row"><label>地址</label><input id="og_addr" type="text" value="2" placeholder="1|2|3|4"></div>
|
||||||
|
<div class="row"><label>模式</label><select id="og_omode"><option value="0">单圈就近</option><option value="1">单圈方向</option><option value="2" selected>多圈碰撞堵转</option><option value="3">多圈限位开关</option></select></div>
|
||||||
|
<div class="row"><label>方向</label><select id="og_odir"><option value="0">CW</option><option value="1">CCW</option></select></div>
|
||||||
|
<div class="row"><label>速度</label><input id="og_ovel" type="number" value="200" min="1" max="5000"><span class="unit">RPM</span></div>
|
||||||
|
<div class="row"><label>超时</label><input id="og_otm" type="number" value="10000" min="0"><span class="unit">ms</span></div>
|
||||||
|
<div class="row"><label>碰撞转速</label><input id="og_slvel" type="number" value="100" min="1" max="5000"><span class="unit">RPM</span></div>
|
||||||
|
<div class="row"><label>碰撞电流</label><input id="og_slma" type="number" value="500" min="1" max="5000"><span class="unit">mA</span></div>
|
||||||
|
<div class="row"><label>碰撞时间</label><input id="og_slms" type="number" value="100" min="1" max="5000"><span class="unit">ms</span></div>
|
||||||
|
<div class="row"><label>存储</label><select id="og_svf"><option value="0">不存储</option><option value="1">存储</option></select></div>
|
||||||
|
<div class="row"><label>上电自回零</label><select id="og_potf"><option value="0">否</option><option value="1">是</option></select></div>
|
||||||
|
<div class="btn-row">
|
||||||
|
<button class="btn-go" onclick="apiEach('origin_set','og_addr','&svf='+v('og_svf'))">设零点</button>
|
||||||
|
<button class="btn-on" onclick="apiEach('origin_config','og_addr','&svf='+v('og_svf')+'&omode='+v('og_omode')+'&odir='+v('og_odir')+'&ovel='+v('og_ovel')+'&otm='+v('og_otm')+'&slvel='+v('og_slvel')+'&slma='+v('og_slma')+'&slms='+v('og_slms')+'&potf='+v('og_potf'))">配置参数</button>
|
||||||
|
</div>
|
||||||
|
<div class="btn-row">
|
||||||
|
<button class="btn-go" onclick="apiEach('origin_go','og_addr','&omode='+v('og_omode'))">触发回零</button>
|
||||||
|
<button class="btn-stop" onclick="apiEach('origin_stop','og_addr','')">中断回零</button>
|
||||||
|
</div>
|
||||||
|
</div>
|
||||||
|
|
||||||
</div>
|
</div>
|
||||||
|
|
||||||
<div class="card" id="proto-card">
|
<div class="card" id="proto-card">
|
||||||
@@ -208,6 +266,39 @@ function api(cmd){
|
|||||||
l.innerHTML='<div class="err">请求失败</div>'+l.innerHTML
|
l.innerHTML='<div class="err">请求失败</div>'+l.innerHTML
|
||||||
})
|
})
|
||||||
}
|
}
|
||||||
|
function apiEach(ep,id,ext){
|
||||||
|
var addrs=v(id).split('|');
|
||||||
|
for(var i=0;i<addrs.length;i++){
|
||||||
|
api(ep+'?addr='+addrs[i].trim()+ext)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
function axisMove(){
|
||||||
|
var x=v('ax_x'),y=v('ax_y'),z=v('ax_zrot'),s=v('ax_servo');
|
||||||
|
var vel=v('ax_vel'),acc=v('ax_acc');
|
||||||
|
api('mm?addr=2&mm='+(x||'0')+'&vel='+vel+'&acc='+acc+'&raf=1');
|
||||||
|
api('mm?addr=3&mm='+(y||'0')+'&vel='+vel+'&acc='+acc+'&raf=1');
|
||||||
|
api('angle?addr=1&angle='+(z||'0')+'&vel='+vel+'&acc='+acc+'&raf=1');
|
||||||
|
api('servo?angle='+(s||'90'));
|
||||||
|
}
|
||||||
|
function readParam(){
|
||||||
|
var addr=v('rp_addr'),param=v('rp_param');
|
||||||
|
fetch('/api/read_param?addr='+addr+'¶m='+param)
|
||||||
|
.then(r=>r.json()).then(d=>{
|
||||||
|
var h='addr='+d.addr+' param='+d.param+' sign='+d.sign;
|
||||||
|
if(d.angle!==undefined){
|
||||||
|
var sg=d.sign?'-':'';
|
||||||
|
h+='<br><b style="color:var(--accent);font-size:1.2rem">'+sg+d.angle.toFixed(2)+'°</b>';
|
||||||
|
h+=' <span style="font-size:.7rem">(raw: '+d.val32+' / 0x'+d.val32.toString(16).toUpperCase()+')</span>';
|
||||||
|
}
|
||||||
|
if(d.val16!==undefined && d.angle===undefined){
|
||||||
|
h+='<br><b style="color:var(--accent)">'+d.val16+'</b> <span style="font-size:.7rem">(16bit)</span>';
|
||||||
|
}
|
||||||
|
h+='<br><span style="font-size:.6rem;opacity:.5">raw: '+d.hex+'</span>';
|
||||||
|
document.getElementById('rp_out').innerHTML = h;
|
||||||
|
}).catch(function(e){
|
||||||
|
document.getElementById('rp_out').innerHTML='读取失败'
|
||||||
|
});
|
||||||
|
}
|
||||||
fetch('/api/status').then(function(r){return r.json()}).then(function(d){
|
fetch('/api/status').then(function(r){return r.json()}).then(function(d){
|
||||||
document.getElementById('wifi').innerHTML='<i class="dot"></i>WiFi: '+d.ssid;
|
document.getElementById('wifi').innerHTML='<i class="dot"></i>WiFi: '+d.ssid;
|
||||||
document.getElementById('ip').textContent='IP: '+d.ip
|
document.getElementById('ip').textContent='IP: '+d.ip
|
||||||
@@ -336,6 +427,20 @@ static int get_query_int(httpd_req_t *req, const char *key, int def)
|
|||||||
return def;
|
return def;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static float get_query_float(httpd_req_t *req, const char *key, float def)
|
||||||
|
{
|
||||||
|
char buf[128];
|
||||||
|
size_t len = httpd_req_get_url_query_len(req) + 1;
|
||||||
|
if (len > sizeof(buf)) len = sizeof(buf);
|
||||||
|
if (httpd_req_get_url_query_str(req, buf, len) == ESP_OK) {
|
||||||
|
char val[16];
|
||||||
|
if (httpd_query_key_value(buf, key, val, sizeof(val)) == ESP_OK) {
|
||||||
|
return (float)atof(val);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return def;
|
||||||
|
}
|
||||||
|
|
||||||
/* ============================================================
|
/* ============================================================
|
||||||
* HTTP 处理器
|
* HTTP 处理器
|
||||||
* ============================================================ */
|
* ============================================================ */
|
||||||
@@ -479,6 +584,204 @@ static esp_err_t api_servo_handler(httpd_req_t *req)
|
|||||||
return ESP_FAIL;
|
return ESP_FAIL;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* ---- 轴联动: XYZA 同时驱动 (mm + °) ---- */
|
||||||
|
static esp_err_t api_axis_handler(httpd_req_t *req)
|
||||||
|
{
|
||||||
|
float x_mm = get_query_float(req, "x", 0.0f);
|
||||||
|
float y_mm = get_query_float(req, "y", 0.0f);
|
||||||
|
float z_deg = get_query_float(req, "zrot", 0.0f);
|
||||||
|
float s_ang = get_query_float(req, "servo", -1.0f);
|
||||||
|
int vel = get_query_int(req, "vel", ACTUATOR_DEFAULT_VEL);
|
||||||
|
int acc = get_query_int(req, "acc", ACTUATOR_DEFAULT_ACC);
|
||||||
|
|
||||||
|
actuator_motor_mm(ACTUATOR_ADDR_X, x_mm, (uint16_t)vel, (uint8_t)acc, true);
|
||||||
|
actuator_motor_mm(ACTUATOR_ADDR_Y1, y_mm, (uint16_t)vel, (uint8_t)acc, true);
|
||||||
|
actuator_motor_angle(ACTUATOR_ADDR_ANGLE, z_deg, (uint16_t)vel, (uint8_t)acc, true);
|
||||||
|
if (s_ang >= 0.0f)
|
||||||
|
actuator_servo_set_angle(s_ang);
|
||||||
|
|
||||||
|
char resp[128];
|
||||||
|
snprintf(resp, sizeof(resp),
|
||||||
|
"轴联动: X=%.1fmm Y=%.1fmm Z=%.1f° Servo=%.1f° vel=%d acc=%d",
|
||||||
|
(double)x_mm, (double)y_mm, (double)z_deg, (double)s_ang, vel, acc);
|
||||||
|
httpd_resp_set_type(req, "text/plain; charset=utf-8");
|
||||||
|
httpd_resp_send(req, resp, HTTPD_RESP_USE_STRLEN);
|
||||||
|
return ESP_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* ---- 直线距离控制: mm → 脉冲 ---- */
|
||||||
|
static esp_err_t api_mm_handler(httpd_req_t *req)
|
||||||
|
{
|
||||||
|
int addr = get_query_int(req, "addr", 2);
|
||||||
|
float mm = get_query_float(req, "mm", 0.0f);
|
||||||
|
int vel = get_query_int(req, "vel", ACTUATOR_DEFAULT_VEL);
|
||||||
|
int acc = get_query_int(req, "acc", ACTUATOR_DEFAULT_ACC);
|
||||||
|
int raf = get_query_int(req, "raf", 1);
|
||||||
|
|
||||||
|
actuator_motor_mm((uint8_t)addr, mm, (uint16_t)vel, (uint8_t)acc, (bool)raf);
|
||||||
|
|
||||||
|
uint32_t clk = ACTUATOR_MM_TO_PULSES(mm);
|
||||||
|
char resp[96];
|
||||||
|
snprintf(resp, sizeof(resp),
|
||||||
|
"直线模式: 地址%d %.2fmm → %lu脉冲 %s vel=%dRPM acc=%d",
|
||||||
|
addr, (double)mm, (unsigned long)clk, raf ? "绝对" : "相对", vel, acc);
|
||||||
|
httpd_resp_set_type(req, "text/plain; charset=utf-8");
|
||||||
|
httpd_resp_send(req, resp, HTTPD_RESP_USE_STRLEN);
|
||||||
|
return ESP_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* ---- 角度直控: ° → 脉冲 ---- */
|
||||||
|
static esp_err_t api_angle_handler(httpd_req_t *req)
|
||||||
|
{
|
||||||
|
int addr = get_query_int(req, "addr", 1);
|
||||||
|
float angle = get_query_float(req, "angle", 0.0f);
|
||||||
|
int vel = get_query_int(req, "vel", ACTUATOR_DEFAULT_VEL);
|
||||||
|
int acc = get_query_int(req, "acc", ACTUATOR_DEFAULT_ACC);
|
||||||
|
int raf = get_query_int(req, "raf", 1);
|
||||||
|
|
||||||
|
actuator_motor_angle((uint8_t)addr, angle, (uint16_t)vel, (uint8_t)acc, (bool)raf);
|
||||||
|
|
||||||
|
uint32_t clk = EMM_V5_DEG_TO_CLK(angle);
|
||||||
|
char resp[96];
|
||||||
|
snprintf(resp, sizeof(resp),
|
||||||
|
"角度模式: 地址%d %.1f° → %lu脉冲 %s vel=%dRPM acc=%d",
|
||||||
|
addr, (double)angle, (unsigned long)clk, raf ? "绝对" : "相对", vel, acc);
|
||||||
|
httpd_resp_set_type(req, "text/plain; charset=utf-8");
|
||||||
|
httpd_resp_send(req, resp, HTTPD_RESP_USE_STRLEN);
|
||||||
|
return ESP_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* ---- 当前位置清零 ---- */
|
||||||
|
static esp_err_t api_reset_pos_handler(httpd_req_t *req)
|
||||||
|
{
|
||||||
|
int addr = get_query_int(req, "addr", 1);
|
||||||
|
Emm_V5_Reset_CurPos_To_Zero((uint8_t)addr);
|
||||||
|
char resp[32];
|
||||||
|
snprintf(resp, sizeof(resp), "电机 %d 位置已清零", addr);
|
||||||
|
httpd_resp_set_type(req, "text/plain; charset=utf-8");
|
||||||
|
httpd_resp_send(req, resp, HTTPD_RESP_USE_STRLEN);
|
||||||
|
return ESP_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* ---- 解除堵转保护 ---- */
|
||||||
|
static esp_err_t api_reset_clog_handler(httpd_req_t *req)
|
||||||
|
{
|
||||||
|
int addr = get_query_int(req, "addr", 1);
|
||||||
|
Emm_V5_Reset_Clog_Pro((uint8_t)addr);
|
||||||
|
char resp[32];
|
||||||
|
snprintf(resp, sizeof(resp), "电机 %d 堵转保护已解除", addr);
|
||||||
|
httpd_resp_set_type(req, "text/plain; charset=utf-8");
|
||||||
|
httpd_resp_send(req, resp, HTTPD_RESP_USE_STRLEN);
|
||||||
|
return ESP_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* ---- 读取系统参数 ---- */
|
||||||
|
static esp_err_t api_read_param_handler(httpd_req_t *req)
|
||||||
|
{
|
||||||
|
int addr = get_query_int(req, "addr", 1);
|
||||||
|
int param = get_query_int(req, "param", 0);
|
||||||
|
|
||||||
|
Emm_V5_Read_Sys_Params((uint8_t)addr, (EmmSysParams_t)param);
|
||||||
|
|
||||||
|
uint8_t rx[128];
|
||||||
|
uint8_t len = Emm_V5_Receive_Data(rx, sizeof(rx));
|
||||||
|
|
||||||
|
uint32_t val32 = 0;
|
||||||
|
uint16_t val16 = 0;
|
||||||
|
int sign = 0;
|
||||||
|
float angle = 0.0f;
|
||||||
|
|
||||||
|
if (len >= 8) {
|
||||||
|
sign = rx[2];
|
||||||
|
val32 = ((uint32_t)rx[3] << 24) | ((uint32_t)rx[4] << 16) |
|
||||||
|
((uint32_t)rx[5] << 8) | ((uint32_t)rx[6]);
|
||||||
|
uint16_t pos16 = (uint16_t)(val32 & 0xFFFF);
|
||||||
|
angle = (sign ? -1.0f : 1.0f) * pos16 * 360.0f / 65536.0f;
|
||||||
|
}
|
||||||
|
if (len >= 6) {
|
||||||
|
val16 = ((uint16_t)rx[3] << 8) | ((uint16_t)rx[4]);
|
||||||
|
}
|
||||||
|
|
||||||
|
char json[512];
|
||||||
|
int off = snprintf(json, sizeof(json),
|
||||||
|
"{\"addr\":%d,\"param\":%d,\"len\":%d,\"sign\":%d"
|
||||||
|
",\"val32\":%lu,\"val16\":%u,\"angle\":%.2f",
|
||||||
|
addr, param, len, sign,
|
||||||
|
(unsigned long)val32, (unsigned)val16, (double)angle);
|
||||||
|
off += snprintf(json + off, sizeof(json) - off, ",\"hex\":\"");
|
||||||
|
for (int i = 0; i < len && off < (int)sizeof(json) - 4; i++) {
|
||||||
|
off += snprintf(json + off, sizeof(json) - off, "%02X", rx[i]);
|
||||||
|
}
|
||||||
|
off += snprintf(json + off, sizeof(json) - off, "\"}");
|
||||||
|
httpd_resp_set_type(req, "application/json");
|
||||||
|
httpd_resp_send(req, json, HTTPD_RESP_USE_STRLEN);
|
||||||
|
return ESP_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* ---- 回零: 设置零点 ---- */
|
||||||
|
static esp_err_t api_origin_set_handler(httpd_req_t *req)
|
||||||
|
{
|
||||||
|
int addr = get_query_int(req, "addr", 1);
|
||||||
|
int svf = get_query_int(req, "svf", 0);
|
||||||
|
Emm_V5_Origin_Set_O((uint8_t)addr, (bool)svf);
|
||||||
|
char resp[48];
|
||||||
|
snprintf(resp, sizeof(resp), "电机 %d 零点已设置 (svF=%d)", addr, svf);
|
||||||
|
httpd_resp_set_type(req, "text/plain; charset=utf-8");
|
||||||
|
httpd_resp_send(req, resp, HTTPD_RESP_USE_STRLEN);
|
||||||
|
return ESP_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* ---- 回零: 配置参数 ---- */
|
||||||
|
static esp_err_t api_origin_config_handler(httpd_req_t *req)
|
||||||
|
{
|
||||||
|
int addr = get_query_int(req, "addr", 1);
|
||||||
|
int svf = get_query_int(req, "svf", 0);
|
||||||
|
int omode = get_query_int(req, "omode", 2); /* 默认: 多圈无限位碰撞 */
|
||||||
|
int odir = get_query_int(req, "odir", 0);
|
||||||
|
int ovel = get_query_int(req, "ovel", 200);
|
||||||
|
int otm = get_query_int(req, "otm", 10000);
|
||||||
|
int slvel = get_query_int(req, "slvel", 100);
|
||||||
|
int slma = get_query_int(req, "slma", 500);
|
||||||
|
int slms = get_query_int(req, "slms", 100);
|
||||||
|
int potf = get_query_int(req, "potf", 0);
|
||||||
|
|
||||||
|
Emm_V5_Origin_Modify_Params((uint8_t)addr, (bool)svf,
|
||||||
|
(uint8_t)omode, (uint8_t)odir, (uint16_t)ovel, (uint32_t)otm,
|
||||||
|
(uint16_t)slvel, (uint16_t)slma, (uint16_t)slms, (bool)potf);
|
||||||
|
char resp[128];
|
||||||
|
snprintf(resp, sizeof(resp),
|
||||||
|
"电机 %d 回零参数已配置 (mode=%d dir=%d vel=%d tm=%lu svF=%d potF=%d)",
|
||||||
|
addr, omode, odir, ovel, (unsigned long)otm, svf, potf);
|
||||||
|
httpd_resp_set_type(req, "text/plain; charset=utf-8");
|
||||||
|
httpd_resp_send(req, resp, HTTPD_RESP_USE_STRLEN);
|
||||||
|
return ESP_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* ---- 回零: 触发回零 ---- */
|
||||||
|
static esp_err_t api_origin_go_handler(httpd_req_t *req)
|
||||||
|
{
|
||||||
|
int addr = get_query_int(req, "addr", 1);
|
||||||
|
int omode = get_query_int(req, "omode", 2); /* 默认: 多圈无限位碰撞 */
|
||||||
|
Emm_V5_Origin_Trigger_Return((uint8_t)addr, (uint8_t)omode, false);
|
||||||
|
char resp[48];
|
||||||
|
snprintf(resp, sizeof(resp), "电机 %d 回零已触发 (mode=%d)", addr, omode);
|
||||||
|
httpd_resp_set_type(req, "text/plain; charset=utf-8");
|
||||||
|
httpd_resp_send(req, resp, HTTPD_RESP_USE_STRLEN);
|
||||||
|
return ESP_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* ---- 回零: 强制中断 ---- */
|
||||||
|
static esp_err_t api_origin_stop_handler(httpd_req_t *req)
|
||||||
|
{
|
||||||
|
int addr = get_query_int(req, "addr", 1);
|
||||||
|
Emm_V5_Origin_Interrupt((uint8_t)addr);
|
||||||
|
char resp[32];
|
||||||
|
snprintf(resp, sizeof(resp), "电机 %d 回零已中断", addr);
|
||||||
|
httpd_resp_set_type(req, "text/plain; charset=utf-8");
|
||||||
|
httpd_resp_send(req, resp, HTTPD_RESP_USE_STRLEN);
|
||||||
|
return ESP_OK;
|
||||||
|
}
|
||||||
|
|
||||||
/* favicon — 204 No Content, 避免浏览器反复请求 */
|
/* favicon — 204 No Content, 避免浏览器反复请求 */
|
||||||
static esp_err_t favicon_handler(httpd_req_t *req)
|
static esp_err_t favicon_handler(httpd_req_t *req)
|
||||||
{
|
{
|
||||||
@@ -602,7 +905,7 @@ static void http_server_init(void)
|
|||||||
httpd_handle_t server = NULL;
|
httpd_handle_t server = NULL;
|
||||||
httpd_config_t cfg = HTTPD_DEFAULT_CONFIG();
|
httpd_config_t cfg = HTTPD_DEFAULT_CONFIG();
|
||||||
cfg.stack_size = 8192; /* 默认 4096 不够, 增大 */
|
cfg.stack_size = 8192; /* 默认 4096 不够, 增大 */
|
||||||
cfg.max_uri_handlers = 16;
|
cfg.max_uri_handlers = 30;
|
||||||
cfg.max_open_sockets = 4;
|
cfg.max_open_sockets = 4;
|
||||||
cfg.lru_purge_enable = true;
|
cfg.lru_purge_enable = true;
|
||||||
|
|
||||||
@@ -672,6 +975,44 @@ static void http_server_init(void)
|
|||||||
};
|
};
|
||||||
httpd_register_uri_handler(server, &uri_servo);
|
httpd_register_uri_handler(server, &uri_servo);
|
||||||
|
|
||||||
|
/* ---- 轴联动 + 直线/角度 ---- */
|
||||||
|
httpd_uri_t uri_axis = {
|
||||||
|
.uri = "/api/axis", .method = HTTP_GET,
|
||||||
|
.handler = api_axis_handler, .user_ctx = NULL
|
||||||
|
};
|
||||||
|
httpd_register_uri_handler(server, &uri_axis);
|
||||||
|
|
||||||
|
httpd_uri_t uri_mm = {
|
||||||
|
.uri = "/api/mm", .method = HTTP_GET,
|
||||||
|
.handler = api_mm_handler, .user_ctx = NULL
|
||||||
|
};
|
||||||
|
httpd_register_uri_handler(server, &uri_mm);
|
||||||
|
|
||||||
|
httpd_uri_t uri_angle = {
|
||||||
|
.uri = "/api/angle", .method = HTTP_GET,
|
||||||
|
.handler = api_angle_handler, .user_ctx = NULL
|
||||||
|
};
|
||||||
|
httpd_register_uri_handler(server, &uri_angle);
|
||||||
|
|
||||||
|
/* ---- 底层调试 API ---- */
|
||||||
|
httpd_uri_t uri_reset_pos = {
|
||||||
|
.uri = "/api/reset_pos", .method = HTTP_GET,
|
||||||
|
.handler = api_reset_pos_handler, .user_ctx = NULL
|
||||||
|
};
|
||||||
|
httpd_register_uri_handler(server, &uri_reset_pos);
|
||||||
|
|
||||||
|
httpd_uri_t uri_reset_clog = {
|
||||||
|
.uri = "/api/reset_clog", .method = HTTP_GET,
|
||||||
|
.handler = api_reset_clog_handler, .user_ctx = NULL
|
||||||
|
};
|
||||||
|
httpd_register_uri_handler(server, &uri_reset_clog);
|
||||||
|
|
||||||
|
httpd_uri_t uri_read_param = {
|
||||||
|
.uri = "/api/read_param", .method = HTTP_GET,
|
||||||
|
.handler = api_read_param_handler, .user_ctx = NULL
|
||||||
|
};
|
||||||
|
httpd_register_uri_handler(server, &uri_read_param);
|
||||||
|
|
||||||
/* favicon.ico — 返回空, 避免 404 警告 */
|
/* favicon.ico — 返回空, 避免 404 警告 */
|
||||||
httpd_uri_t uri_favicon = {
|
httpd_uri_t uri_favicon = {
|
||||||
.uri = "/favicon.ico",
|
.uri = "/favicon.ico",
|
||||||
@@ -681,6 +1022,31 @@ static void http_server_init(void)
|
|||||||
};
|
};
|
||||||
httpd_register_uri_handler(server, &uri_favicon);
|
httpd_register_uri_handler(server, &uri_favicon);
|
||||||
|
|
||||||
|
/* ---- 回零校准 API ---- */
|
||||||
|
httpd_uri_t uri_origin_set = {
|
||||||
|
.uri = "/api/origin_set", .method = HTTP_GET,
|
||||||
|
.handler = api_origin_set_handler, .user_ctx = NULL
|
||||||
|
};
|
||||||
|
httpd_register_uri_handler(server, &uri_origin_set);
|
||||||
|
|
||||||
|
httpd_uri_t uri_origin_config = {
|
||||||
|
.uri = "/api/origin_config", .method = HTTP_GET,
|
||||||
|
.handler = api_origin_config_handler, .user_ctx = NULL
|
||||||
|
};
|
||||||
|
httpd_register_uri_handler(server, &uri_origin_config);
|
||||||
|
|
||||||
|
httpd_uri_t uri_origin_go = {
|
||||||
|
.uri = "/api/origin_go", .method = HTTP_GET,
|
||||||
|
.handler = api_origin_go_handler, .user_ctx = NULL
|
||||||
|
};
|
||||||
|
httpd_register_uri_handler(server, &uri_origin_go);
|
||||||
|
|
||||||
|
httpd_uri_t uri_origin_stop = {
|
||||||
|
.uri = "/api/origin_stop", .method = HTTP_GET,
|
||||||
|
.handler = api_origin_stop_handler, .user_ctx = NULL
|
||||||
|
};
|
||||||
|
httpd_register_uri_handler(server, &uri_origin_stop);
|
||||||
|
|
||||||
/* ---- 协议状态 API ---- */
|
/* ---- 协议状态 API ---- */
|
||||||
httpd_uri_t uri_proto_status = {
|
httpd_uri_t uri_proto_status = {
|
||||||
.uri = "/api/proto/status",
|
.uri = "/api/proto/status",
|
||||||
|
|||||||
Reference in new issue
Block a user