meswork/wasm-simulator
6
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Emit motion control mode events

Browse Source
This commit is contained in:
CNC Local
2026-05-22 05:39:59 +08:00
parent e941c9bbb4
commit 44e024e49c
7 changed files with 121 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

26
core/src/linuxcnc_canon_bridge.cpp
View File

@@ -302,7 +302,31 @@ void SET_FEED_MODE(int, int) {
}
}
void SET_MOTION_CONTROL_MODE(CANON_MOTION_MODE, double) {
void SET_MOTION_CONTROL_MODE(CANON_MOTION_MODE mode, double tolerance) {
int reserved = 0;
switch (mode) {
case CANON_EXACT_PATH:
reserved = 611;
break;
case CANON_EXACT_STOP:
reserved = 612;
break;
case CANON_CONTINUOUS:
reserved = 640;
break;
default:
reserved = 0;
break;
}
if (active_sink) {
CncSimEvent event{};
event.version = 1;
event.type = CNC_SIM_EVENT_COMMENT;
event.line = event_line();
event.feed = tolerance;
event.reserved = reserved;
active_sink->emit_raw(event);
}
}
void SET_NAIVECAM_TOLERANCE(double) {

16
core/src/smoke_gcode_parser.cpp
View File

@@ -323,6 +323,22 @@ int SmokeGcodeParser::parse(const char *program, size_t program_len, std::string
if (stop_if_callback_aborted(sink_, error)) {
return -1;
}
} else if (g == 61) {
emit_comment_state(sink_, line_number, g_code_is(word.value, 61.1) ? 612 : 611);
if (stop_if_callback_aborted(sink_, error)) {
return -1;
}
} else if (g == 64) {
CncSimEvent event{};
event.version = 1;
event.type = CNC_SIM_EVENT_COMMENT;
event.line = line_number;
event.feed = words.count('P') ? words.at('P') : 0.0;
event.reserved = 640;
sink_.emit_raw(event);
if (stop_if_callback_aborted(sink_, error)) {
return -1;
}
} else if (g == 0 || g == 1 || g == 2 || g == 3) {
modal_motion = g;
} else if (g == 4) {

31
core/tests/cnc_sim_api_linuxcnc_rs274_smoke.cpp
View File

@@ -91,6 +91,9 @@ int main() {
bool saw_g95_mode = false;
bool saw_g94_feed_mode = false;
bool saw_g95_feed_mode = false;
bool saw_g61_mode = false;
bool saw_g611_mode = false;
bool saw_g64_mode = false;
for (const auto &event : events) {
saw_tool = saw_tool || event.type == CNC_SIM_EVENT_TOOL_CHANGE;
saw_rapid = saw_rapid || event.type == CNC_SIM_EVENT_RAPID;
@@ -285,6 +288,34 @@ int main() {
ok &= expect(saw_g94_feed_mode, "expected LinuxCNC G94 set-feed mode event");
ok &= expect(saw_g95_feed_mode, "expected LinuxCNC G95 set-feed mode event");
const char motion_mode_program[] =
"G21 G90 G17\n"
"G61\n"
"G61.1\n"
"G64 P0.05\n"
"M30\n";
events.clear();
ok &= expect(cnc_sim_parse_program(sim, motion_mode_program, sizeof(motion_mode_program) - 1) == 0,
cnc_sim_last_error(sim));
for (const auto &event : events) {
saw_g61_mode = saw_g61_mode ||
(event.type == CNC_SIM_EVENT_COMMENT &&
event.line == 2 &&
event.reserved == 611);
saw_g611_mode = saw_g611_mode ||
(event.type == CNC_SIM_EVENT_COMMENT &&
event.line == 3 &&
event.reserved == 612);
saw_g64_mode = saw_g64_mode ||
(event.type == CNC_SIM_EVENT_COMMENT &&
event.line == 4 &&
event.reserved == 640 &&
event.feed == 0.05);
}
ok &= expect(saw_g61_mode, "expected LinuxCNC G61 exact path mode");
ok &= expect(saw_g611_mode, "expected LinuxCNC G61.1 exact stop mode");
ok &= expect(saw_g64_mode, "expected LinuxCNC G64 continuous mode");
const char comment_program[] =
"G21 G90 G17\n"
"(operator note)\n"

30
core/tests/cnc_sim_api_smoke.cpp
View File

@@ -81,6 +81,9 @@ int main() {
bool saw_g94_mode = false;
bool saw_g95_mode = false;
bool saw_g95_feed_mode = false;
bool saw_g61_mode = false;
bool saw_g611_mode = false;
bool saw_g64_mode = false;
bool saw_incremental_move = false;
bool saw_r_arc_center = false;
for (const auto &event : events) {
@@ -261,6 +264,33 @@ int main() {
ok &= expect(saw_g95_mode, "expected G95 feed mode state");
ok &= expect(saw_g95_feed_mode, "expected G95 feed-per-rev set-feed mode");
const char motion_mode_program[] =
"G21\n"
"G61\n"
"G61.1\n"
"G64 P0.05\n";
events.clear();
ok &= expect(cnc_sim_parse_program(sim, motion_mode_program, sizeof(motion_mode_program) - 1) == 0,
cnc_sim_last_error(sim));
for (const auto &event : events) {
saw_g61_mode = saw_g61_mode ||
(event.type == CNC_SIM_EVENT_COMMENT &&
event.line == 2 &&
event.reserved == 611);
saw_g611_mode = saw_g611_mode ||
(event.type == CNC_SIM_EVENT_COMMENT &&
event.line == 3 &&
event.reserved == 612);
saw_g64_mode = saw_g64_mode ||
(event.type == CNC_SIM_EVENT_COMMENT &&
event.line == 4 &&
event.reserved == 640 &&
event.feed == 0.05);
}
ok &= expect(saw_g61_mode, "expected G61 exact path mode");
ok &= expect(saw_g611_mode, "expected G61.1 exact stop mode");
ok &= expect(saw_g64_mode, "expected G64 continuous mode");
const char linuxcnc_config[] = "{\"backend\":\"linuxcnc-rs274\"}";
config_rc = cnc_sim_load_config_json(sim, linuxcnc_config, sizeof(linuxcnc_config) - 1);
rc = cnc_sim_parse_program(sim, program, sizeof(program) - 1);