"废物利用"也抄袭——废旧喷墨打印机和光驱DIY"绘图仪"

    很长时间没有写博客,因为各种各样的事情占去大块时间,只有零碎时间偶尔在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一起入手一块恒压恒流模块准备给它供电,这样就可以功率调节到合适的程度,当然散热器上带个小风扇是一定的。后面再利用打印机的字车扩大一下雕刻范围,也许还会买个光轴做个大一点的。

原文地址:https://www.cnblogs.com/zcsor/p/8605703.html