很长时间没有写博客,因为各种各样的事情占去大块时间,只有零碎时间偶尔在CSDN逛逛也偶尔回几个帖子。很久以前就看到一些光驱DIY雕刻机之类的,很是向往,最近这几天得闲就TB了一套Arduino UNO R3实验套件,也实践了一番这种单任务平台,从点亮个LED翻到步进电机就再也忍不住了,于是狠狠的操作了一番ULN2003和28BYJ48,好在经过对度娘的一番拷问,了解了不少东西,基本了解了各种所需的基本知识,其中比较需要自己实验的方面列出来,以供大家参考:
一、步进电机、驱动和接线
买了两个L298N来驱动光驱步进电机,其中in1-in4就是接Arduino程序里面定义的引脚1-4,电源采用12V供电。我拆的两个光驱电机(拆了3个其中一个是无刷的),具体接法可以自己试一试,连接两个引脚之后转动有阻力的就是一组,有万用表测一下也可以的。我这两个光驱电机都是依次排列的,即12、34两组,所以接的时候依次接L298N的ou1-ou4即可。唯一需要注意的地方就是L298N的GND接到Arduino的GND上。
二、给Arduino编程
用c写代码还是蛮别扭的,就像你开了这么多年自动挡,让你开手动档能不能走起呢?当然能,就是得光想着离合那点事。这里主要考虑的就是绘图的话那2k的内存不好办,所以还得上位机控制,所以整个程序框架建立的时候就是服从上位机指令;然后就是电机工作的平稳性,如果电机带着整个机械机构在那广场舞,那激光指不定射谁一眼呢(虽然我打算绑只圆珠笔搞定),所以平稳还是要的,也就修改了电机库使它从4拍变为8拍并且增加了S型加速。所以说,驱动细分不细分的,软件实现就可以了,毕竟我们的要求不高,2k内存还是绰绰有余的。
1、与上位机通讯
发送消息很简单:
//请求数据 void RequestData() { Serial.println(r_RequestData); delayMicroseconds(2000); //16000000/96000=1666.66666 }
注意别粘包了就好。而且发送的字符尽量少,1个字节可以表示二百五还多的命令很够用了。
接收消息也不难,分类处理一下就可以了:
//板子初始化操作后进入的循环执行函数。 void loop() { if (Serial.available()!=0) { msgLen = Serial.readBytes(msgBuff, msgBuffSize); //读取消息 if (msgLen > 0) { CommandParsing(msgBuff); //处理消息 } }else{ RequestData(); //请求数据 } } void CommandParsing(char buff[]) { if (buff[0] == c_Stop) { DoStop(); }else if (buff[0] == c_xForward || buff[0]==c_xBackOff) { DoxMove(buff[0], ToInt32(buff)); }else if (buff[0] == c_yForward || buff[0] == c_yBackOff) { DoyMove(buff[0], ToInt32(buff)); }else if (buff[0] == c_zUp || buff[0] == c_zDown) { DozMove(buff[0]); }else if (buff[0] == c_xSpeed) { xSpeed = ToFloat(buff); Serial.println(xSpeed); xStepper.setSpeed(xSpeed); }else if (buff[0] == c_ySpeed) { ySpeed = ToFloat(buff); yStepper.setSpeed(ySpeed); }else { Serial.println(r_UnknownCommand); } memset(msgBuff, 0, msgBuffSize); }
我的接收缓冲区只有5字节,也就是说每个命令都一样长——5字节,这可以让代码简单一些,看了一下Serial的源码,里面设置了接收缓冲区64字节,所以上位机可以一口气发10个命令,再多就被舍弃了,还是等待下位机请求之后再发才保险。
2、修改Stepper库
绝大部分还是保留原来的内容,只是稍作修改,在Stepper_CDROM.h中:
const int number_of_steps=8; // total number of steps this motor can take unsigned long CurDelay; unsigned long GetSModelLine(int StepCount,int StepLeft); float sSpeed[8] = {16.6667, 7.1429, 4.1667, 2.5, 1.6667, 1.3158, 1.1628, 1.0638};
把原来构造函数的第一个参数修改为常量8,后面也跟着修改了setSpeed函数的实现:
//设置每分钟转多少步 void Stepper_CDROM::setSpeed(float whatSpeed) { this->step_delay = 60L * 1000L * 1000L / this->number_of_steps / whatSpeed; }
就如注释的一样,设置的速度是每分钟的步数而不是转数,其实这个值最后还是要不断的调试得出,我最后确定了用这样一个数值:
float ySpeed = 4864; //y轴步进电机每分钟步数的最大值
而和原来代码格格不入的变量名就是我搞出来的了,为了计算S型加速曲线,实际上只有8步速或减速过程,这些数值是最高速时的时间间隔的倍数。虽然这样做要比Exp函数(S型曲线的原函数计算非常耗时)来的快的多得多,但是由于我没有这方面的经验,所以步数和加速度可能很不理想。但是无论如何,我修改了原来代码的内容,使用了我的时间间隔来代替原有间隔,做为萌新看起来可能还不错:
void Stepper_CDROM::step(int steps_to_move) { int steps_left; if (steps_to_move > 0) { this->direction = 1; steps_left = steps_to_move; } if (steps_to_move < 0) { this->direction = 0; steps_left = -steps_to_move; } int StepCount = steps_left; this->CurDelay = GetSModelLine(StepCount,steps_to_move); // 到达延迟时间后转动一步,直到转动全部步数。 while (steps_left > 0) { unsigned long now = micros(); // 计算延迟是否到达 if (now - this->last_step_time >= CurDelay) { // 记录本次转动时间: this->last_step_time = now; // 根据方向设置当前拍: if (this->direction == 1) { this->step_number++; if (this->step_number == this->number_of_steps) { this->step_number = 0; } } else { if (this->step_number == 0) { this->step_number = this->number_of_steps; } this->step_number--; } // 记录剩余步数: steps_left--; // 运行电机 stepMotor(this->step_number % 8); //计算下一个延迟 this->CurDelay = GetSModelLine(StepCount, steps_left); } } } unsigned long Stepper_CDROM::GetSModelLine(int StepCount,int StepLeft) { if (StepCount < 16) { return this->step_delay*2; //不足16步则无法完成一次加速和一次减速,以1/2最高速度运行。 } if (StepLeft <= 8) { return this->step_delay * this->sSpeed[StepLeft-1]; //最后8拍倒序执行即减速。 } if (StepCount - StepLeft < 8) { return this->step_delay * this->sSpeed[StepCount - StepLeft]; //前8拍顺序执行即加速。 } return this->step_delay; //前后8拍之间的最高速度运行。 }
红的的行就是应用我的时间间隔的地方了,而下面的自定义函数就是计算过程,这只需要查表就可以了,当然,我懒到对于不能进行完整加减速的过程简单粗暴的用了一个半速。但无论如何,经过各种调试,现在这个光驱里拆出来的架子上面的机械机构运行时速度很快,声音很小;当然,还有更重要的一点,我测试的结果是500拍就差不多从一端走到另一端共3.8cm、12圈多一点,所以这个电机大约是40步转一圈,细分8拍之后,每一拍大约0.076mm,这个精度也可以了,但是如果用原来的库进行4拍驱动就只能达到0.152的精度,走6拍差不多1mm了,很明显的锯齿有木有。之前上传的程序有一点问题,已经修正了。下面添加一个光驱电机8拍的顺序:
1000、1100、0100、0110、0010、0011、0001、1001。1表示高电平,0表示低电平。
这几天又看了看A4988驱动,准备入手两三块,这个驱动编写程序要简单很多。
3、上位机程序
这下开上自动挡的赶脚又回来了,很简单的封一个类就可以:
Private Enum Command As Byte c_Stop = 255 '暂停 c_Continue = 254 '继续 c_xForward = 1 'x轴前进 c_xBackOff = 2 'x轴后退 c_yForward = 3 'y轴前进 c_yBackOff = 4 'y轴后退 c_zUp = 5 'z轴抬起 c_zDown = 6 'z轴落下 c_xSpeed = 7 'x轴速度 c_ySpeed = 8 'y轴速度 End Enum Private Enum Request As Byte r_UnknownCommand = Asc("d") '未知命令 r_RequestData = Asc("e") '请求数据 End Enum Private WithEvents mPort As SerialPort Event RequestData(msg As String) Sub New(PortName As String, BaudRate As Integer) mPort = New SerialPort(PortName) mPort.BaudRate = BaudRate Try mPort.Open() Catch ex As Exception MsgBox(ex.ToString) End Try End Sub Private Sub mPort_DataReceived(sender As Object, e As SerialDataReceivedEventArgs) Handles mPort.DataReceived Dim inData As String = CType(sender, SerialPort).ReadLine.TrimEnd({CChar(vbCr), CChar(vbLf)}) RaiseEvent RequestData(inData) End Sub Private Sub mPort_Disposed(sender As Object, e As EventArgs) Handles mPort.Disposed Try If mPort IsNot Nothing AndAlso mPort.IsOpen Then mPort.Close() End If Catch ex As Exception End Try End Sub Sub SendCommand_Stop() WritePort({Command.c_Stop, 0, 0, 0, 0}) End Sub
‘此处省略其他函数封装。
Private Sub WritePort(buff() As Byte)
Try
mPort.Write(buff, 0, 5)
Catch ex As Exception
MsgBox(ex.ToString)
End Try
End Sub
使用指定的端口名和波特率初始化一下端口类,定义命令和请求,然后封装好不同的命令和请求就可以了,当然这里请求处理还不完整也为了测试方便,把请求事件那里的条件去掉了,但并不影响对整个程序结构的理解。
虽然我的上位机程序对通讯部分进行了很多修改,但是整个框架还是这样的。添加了一些简单的功能,但是有些部分还不是很成熟,把经过测试没有问题的部分说明一下:
3.1图像的简单处理:
我使用了OPENCV组件(NUGET)来完成这样几个工作:
A、读取和显示图片
Dim ofd As New OpenFileDialog Try ofd.Filter = "jpg files|*.jpg|png files|*.png|bmp files|*.bmp|all files|*.*" ofd.Multiselect = False If ofd.ShowDialog = DialogResult.OK Then ImgSrc = New Mat(ofd.FileName) pnlSrc.BackgroundImage = Mat2Img(ImgSrc) End If Catch ex As Exception MsgBox(ex.ToString) End Try
这个程序很简单,就是读取文件然后显示在Panel上。其中Mat2Img函数如下:
Private Function Mat2Img(mat As Mat) As Bitmap Dim ms As New MemoryStream mat.WriteToStream(ms) Dim result As Bitmap = Bitmap.FromStream(ms) ms.Close() Return result End Function
就是利用内存流转储一下而已。
B、灰度化、二值化、边缘查找
ImgGray = ImgSrc.CvtColor(ColorConversionCodes.BGR2GRAY)
ImgBinary = ImgGray.Threshold(nudThreshValue.Value, nudThreshMaxValue.Value, cmb2ThresholdTypes)
Dim pss()() = ImgBinary.FindContoursAsArray(cmb2RetrievalModes, cmb2ContourApproximationModes)
这样就可以得到边缘的点坐标集合,并且这些点是相连的,所以可以优化绘制代码——按曲线绘制,比一行一行扫描看起来高大上一些。
C、二值图也按曲线绘制
这个功能还是利用我所熟悉的快速种子填充算法来做,只是Mat类获取点颜色的方法不太一样:
Private Function FindRegionByPoint(img As Mat, mTable(,) As Boolean, rect As Rect, p As Point, color As Byte) As Point() Dim result As New List(Of Point) Dim mArray As New Queue '栈——将处理点表 Dim mP As Point = p '正在处理点 Dim mAP As Point '临时变量——可能被入栈的点 mArray.Enqueue(mP) '入栈 Do If mTable(mP.X, mP.Y) = False Then '若未处理过 If img.At(Of Byte)(mP.Y, mP.X) = color Then '相同颜色则添加临近点 mAP = New Point(mP.X, mP.Y - 1) '临近点入栈 If rect.Contains(mAP) AndAlso mTable(mAP.X, mAP.Y) = False Then mArray.Enqueue(mAP) mAP = New Point(mP.X, mP.Y + 1) If rect.Contains(mAP) AndAlso mTable(mAP.X, mAP.Y) = False Then mArray.Enqueue(mAP) mAP = New Point(mP.X - 1, mP.Y) If rect.Contains(mAP) AndAlso mTable(mAP.X, mAP.Y) = False Then mArray.Enqueue(mAP) mAP = New Point(mP.X + 1, mP.Y) If rect.Contains(mAP) AndAlso mTable(mAP.X, mAP.Y) = False Then mArray.Enqueue(mAP) result.Add(New Point(mP.X, mP.Y)) End If mTable(mP.X, mP.Y) = True '修改为已处理 End If If mArray.Count = 0 Then Exit Do Else mP = mArray.Dequeue '出栈 Loop Return result.ToArray End Function
这个函数中使用了一个加速表,因为这个函数只是从一个点来查找一片点,有多个相连的点集的时候需要重复调用,所以加速表是重复使用的,当然以前做过一些简单的测试,用bitarray来实现速度还要快一点。至于遍历整个图像的函数就不贴了,两层循环而已,没意思。
以上就是这些天做的一些努力,当然了,今天100大洋的激光头也到货了,插在两个光驱做的框架上做了一下测试,也遇到一些问题。激光器模组的散热套连个硅脂都不送,贴合不紧导热不好,在现在低负荷运行的条件下根本不发热,也就没处理;接的电源过了ULN2003之后电压降很多,又没有合适的变压器,索性直接插了Ardiuno,所以电流很低,和A4988一起入手一块恒压恒流模块准备给它供电,这样就可以功率调节到合适的程度,当然散热器上带个小风扇是一定的。后面再利用打印机的字车扩大一下雕刻范围,也许还会买个光轴做个大一点的。