DIY小型写字机实战：用MKS SERVO57D闭环步进电机和STM32F103实现精准绘图

DIY小型写字机实战：用MKS SERVO57D闭环步进电机和STM32F103实现精准绘图

周末的工作台上，一台自制的写字机正在白纸上流畅地绘制着复杂的几何图案。这台看似简单的设备背后，是闭环步进电机精准控制技术与嵌入式系统的完美结合。本文将带你从零开始，构建一个基于MKS SERVO57D闭环步进电机和STM32F103控制器的智能写字机，探索从机械结构设计到运动控制算法的完整实现过程。

1. 项目规划与硬件选型

在开始动手之前，我们需要对整个项目进行系统规划。写字机的核心功能是通过精确控制笔尖在二维平面上的运动轨迹，完成各种文字和图形的绘制。这要求我们构建一个稳定的机械平台，并选择合适的控制方案。

1.1 核心硬件组件

XY轴运动平台的选择至关重要，它直接决定了写字机的精度和稳定性。我们推荐使用以下配置：

• MKS SERVO57D闭环步进电机（2台）：内置高精度编码器，支持脉冲和串口双控制模式
• STM32F103C8T6最小系统板：性价比高，资源丰富，适合运动控制应用
• 直线导轨和滑块：确保运动平稳无晃动
• 同步带和皮带轮：传动效率高，回程间隙小
• 3D打印结构件：自定义设计，灵活适配各种需求

// 电机基本参数示例 #define MOTOR_STEPS_PER_REV 200 // 步进电机每转步数 #define MICROSTEPS 16 // 细分设置 #define BELT_PITCH 2 // 同步带齿距(mm) #define PULLEY_TEETH 20 // 皮带轮齿数

1.2 闭环步进电机的优势

相比传统开环步进电机，MKS SERVO57D闭环步进电机具有显著优势：

特性	开环步进电机	MKS SERVO57D闭环步进电机
丢步检测	无	实时位置反馈
运行噪音	较大	安静平稳
低速振动	明显	几乎无振动
动态响应	一般	快速响应
位置精度	依赖机械精度	±0.05°(无累积误差)

2. 机械结构设计与组装

写字机的机械结构需要兼顾刚性和精度。我们采用经典的CoreXY结构，这种设计将两个电机的运动耦合到XY轴上，减少了移动部件的质量。

2.1 CoreXY结构原理

CoreXY机构的运动学原理可以用以下方程表示：

X轴运动 = (电机A + 电机B) / 2 Y轴运动 = (电机A - 电机B) / 2

这种设计的特点是：

• 电机固定在机架上，不随运动平台移动
• 减少了运动部件的质量，提高动态性能
• 同步带交叉布置，实现运动解耦

2.2 3D打印部件制作

使用CAD软件(如Fusion 360)设计结构件时，需要注意以下要点：

1. 电机安装座：确保电机轴与皮带轮同心，避免偏心振动
2. 滑块连接件：与直线导轨配合紧密，无晃动
3. 笔夹机构：可调节压力，确保不同笔型都能稳定书写
4. 整体框架：具有足够的刚性，防止共振

提示：打印时使用PETG材料，比PLA更具韧性和耐温性。关键受力部位建议设置40%以上的填充密度。

3. 电路连接与硬件配置

正确的电路连接是系统稳定运行的基础。STM32控制器需要与MKS SERVO57D电机建立可靠的通信。

3.1 脉冲模式接线

当使用脉冲方向控制时，连接方式如下：

STM32引脚	SERVO57D接口	功能说明
PA6	PUL+	脉冲信号正极
GND	PUL-	脉冲信号负极
PA7	DIR+	方向信号正极
GND	DIR-	方向信号负极
+5V	EN+	使能信号正极
GND	EN-	使能信号负极

// STM32定时器配置示例(TIM3用于生成脉冲) void TIM3_Configuration(void) { TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); TIM_TimeBaseStructure.TIM_Period = 1000 - 1; TIM_TimeBaseStructure.TIM_Prescaler = 72 - 1; // 1MHz计数频率 TIM_TimeBaseStructure.TIM_ClockDivision = 0; TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure); TIM_OCInitTypeDef TIM_OCInitStructure; TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; TIM_OCInitStructure.TIM_Pulse = 500; // 50%占空比 TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; TIM_OC1Init(TIM3, &TIM_OCInitStructure); TIM_Cmd(TIM3, ENABLE); }

3.2 串口模式配置

如需使用RS485通信，需要额外添加MAX485电平转换模块。配置步骤如下：

1. 设置电机波特率：通过电机屏幕菜单选择UartBaud→38400
2. 设置从机地址：菜单→UartAddr→01(可设置1-247)
3. 连接MAX485模块：
   • STM32的USART1_TX接MAX485的DI
   • USART1_RX接RO
   • 控制引脚接RE和DE(共同控制收发切换)

4. 运动控制算法实现

写字机的核心是运动控制算法，需要处理轨迹规划、速度曲线生成和实时位置校正。

4.1 直线插补算法

直线插补是将两点之间的路径分解为微小线段的过程。实现步骤包括：

1. 计算总步数：根据目标坐标和当前位置，确定X、Y轴需要移动的步数
2. 确定主导轴：选择步数较多的轴作为基准
3. 计算步进间隔：使用Bresenham算法确定各轴的步进时机

// Bresenham直线插补算法实现 void line_interpolate(int x0, int y0, int x1, int y1) { int dx = abs(x1 - x0); int dy = abs(y1 - y0); int sx = (x0 < x1) ? 1 : -1; int sy = (y0 < y1) ? 1 : -1; int err = dx - dy; while(1) { step_motor(X_AXIS, x0); step_motor(Y_AXIS, y0); if(x0 == x1 && y0 == y1) break; int e2 = 2 * err; if(e2 > -dy) { err -= dy; x0 += sx; } if(e2 < dx) { err += dx; y0 += sy; } } }

4.2 S曲线速度规划

为了避免电机启停时的冲击，我们需要采用S型速度曲线：

1. 加速阶段：速度按S型曲线增加，减小机械冲击
2. 匀速阶段：保持恒定速度运行
3. 减速阶段：对称地减速到停止

速度曲线的实现需要考虑以下参数：

• 最大速度(Vmax)
• 加速度(a)
• 加加速度(jerk)

4.3 闭环位置校正

MKS SERVO57D内置编码器可以提供实时位置反馈。我们可以通过串口读取位置误差，进行动态调整：

// 读取位置误差示例 float read_position_error(uint8_t motor_id) { uint8_t cmd[] = {motor_id, 0x03, 0x00, 0x1A, 0x00, 0x01}; uint8_t response[7]; send_rs485_command(cmd, sizeof(cmd)); if(receive_rs485_response(response, sizeof(response)) == 7) { int16_t error = (response[3] << 8) | response[4]; return (error * 360.0) / 51200.0; // 转换为角度 } return 0.0; }

5. 软件系统架构

完整的写字机控制系统需要良好的软件架构，将硬件驱动、运动算法和用户界面分层实现。

5.1 主控制流程

系统主循环包含以下关键任务：

1. 用户输入处理：解析G代码或图形界面指令
2. 运动规划：生成平滑的运动轨迹
3. 电机控制：输出脉冲或串口指令
4. 状态监测：读取电机反馈，确保系统正常运行
5. 异常处理：检测并恢复错误状态

主控制流程图： [用户输入] → [指令解析] → [轨迹规划] → [电机驱动] → [位置反馈] ↑ ↓ [界面更新] ← [系统状态] ← [异常检测]

5.2 G代码解释器实现

G代码是控制CNC设备的通用语言，基本解释器功能包括：

• 支持G0(快速移动)、G1(直线插补)等基本指令
• 解析坐标参数(X、Y、Z)
• 处理速度参数(F)
• 实现坐标系转换

// 简化的G代码解析示例 void parse_gcode(char *line) { char cmd = line[0]; float x = 0, y = 0, f = 0; // 提取参数 char *ptr = line + 1; while(*ptr) { switch(*ptr++) { case 'X': x = atof(ptr); break; case 'Y': y = atof(ptr); break; case 'F': f = atof(ptr); break; } while(*ptr && *ptr != ' ') ptr++; } // 执行命令 switch(cmd) { case 'G': if(atoi(line+1) == 0 || atoi(line+1) == 1) { move_to(x, y, f); } break; } }

6. 系统调试与优化

完成硬件组装和软件编写后，需要进行系统级调试，确保各部件协调工作。

6.1 机械校准步骤

1. 轴对齐校准：使用直角尺检查X、Y轴是否垂直
2. 皮带张力调整：确保皮带松紧适中，无打滑或过紧
3. 运动平台平衡：手动移动平台，检查各处阻力是否均匀
4. 笔尖高度调整：确保不同压力下笔迹一致

6.2 电机参数调优

通过MKS SERVO57D的屏幕菜单或串口命令，可以优化电机性能：

• 电流设置：根据负载调整运行电流，平衡发热和扭矩
• 细分设置：提高细分可减少振动，但会增加控制器负担
• PID参数：调整位置环PID，优化动态响应

注意：首次使用时必须执行电机自动校准(菜单→Motor→AutoTune)，否则可能无法达到标称精度。

6.3 常见问题排查

在调试过程中可能会遇到以下典型问题：

1. 电机不转动：

   • 检查使能信号(EN)是否有效
   • 确认脉冲信号频率在电机接受范围内(通常<100kHz)
   • 测量驱动器供电电压(建议24-48V)

2. 位置偏差大：

   • 检查机械结构是否有松动
   • 验证编码器反馈是否正常
   • 调整PID参数，增强位置环刚度

3. 运动不流畅：

   • 优化速度规划参数(加速度、加加速度)
   • 检查同步带是否打滑
   • 确保导轨润滑良好

7. 应用扩展与创意实现

基础写字机完成后，可以通过多种方式扩展其功能和应用场景。

7.1 支持多种书写工具

通过更换笔夹模块，可以适配不同类型的书写工具：

• 马克笔：用于大幅面绘图
• 圆珠笔：日常书写和小型绘图
• 激光模块：实现激光雕刻功能
• 小功率主轴：升级为轻型雕刻机

7.2 高级功能实现

1. 离线绘图：添加SD卡模块，脱机运行G代码文件
2. 无线控制：集成蓝牙或WiFi模块，通过手机APP控制
3. 图像转换：开发位图转G代码的转换工具
4. 力反馈：添加压力传感器，实现可变压力书写

# 简单的图像转G代码示例(Python) from PIL import Image def image_to_gcode(image_path, output_size=100): img = Image.open(image_path).convert('L') img = img.resize((output_size, output_size)) pixels = img.load() with open('output.gcode', 'w') as f: f.write("G21\nG90\n") # 毫米单位，绝对坐标 for y in range(output_size): for x in range(output_size): if pixels[x, y] < 128: # 暗色区域下笔 f.write(f"G1 X{x} Y{y} F1000\n") f.write("M3 S1000\n") # 下笔 f.write("M3 S0\n") # 抬笔

7.3 创意项目灵感

基于此平台可以开发多种创意项目：

• 自动签名机：存储和复现手写签名
• 艺术绘图机：生成算法艺术图案
• 教育工具：演示数学曲线和几何图形
• PCB绘图机：直接绘制电路板布线

在完成基础版本后，我尝试增加了压力感应模块，使写字机能够模拟毛笔的提按效果。这个改进让书写更具表现力，但也带来了新的挑战——需要更精细的控制算法来处理动态变化的压力参数。经过多次调整PID参数和优化运动轨迹后，最终实现了令人满意的书法效果。