关键词:
创客教育
六自由度机械臂
轨迹规划
改进遗传算法
参数无因次化
摘要:
伴随着我国创新驱动战略的发展,各个领域对人才的需求越来越多,促使国家更加重视青少年创新能力的培养,促进了创客教育的蓬勃发展。而创客教育高质量的发展对教学设备的层次、质量和数量要求越来越高。同时,在中国制造2025战略方针的指导下,计算机技术和芯片技术高速发展,机械臂已经进入了人们生产和生活领域,大量的应用在工业生产、勘探救援、医疗保健、物流服务、家庭娱乐等场合。为适应创客教育机器人项目培训的要求,开发低成本、高质量的机械臂教育资源,本文设计了一种面向创客教育的六自由度桌面型机械臂。
文中完成了机械臂的结构设计,进行了正、逆运动学分析,利用D-H参数法推导了机械臂的运动学方程,建立了连杆坐标系,构建D-H参数表,建立了机械臂末端相对于基座的齐次变换矩阵。并采用代数法进行逆运动学分析,讨论了多组解对应的位形,并给出建议解。进一步推导了雅可比矩阵,分析了机械臂的三种奇异位形。采用蒙特卡洛法进行分析了机械臂的可达工作空间。利用MATLAB的机器人工具箱中建立仿真模型,验证了正逆运动学计算结果,并用点状图显示了可达工作空间。设计适用于创客教育的六轴机械臂,对结构进行设计和硬件电路和软件编程。
为了减少机械臂运动过程中的冲击和振动,实现运动轨迹的平滑,针对点到点的运动进行了轨迹规划。在关节空间进行了多项式插值轨迹分析,利用边界条件获得三次多项式和三次B样条轨迹曲线方程。针对有中间路径点的情况,利用3-5-3多项式曲线差值进行了轨迹规划,并利用遗传算法和粒子群算法理,在最大速度和加速度约束条件下以时间最短作为目标函数进行优化,获得时间最短的轨迹曲线。
针对关节空间中机械臂在点到点的运动时计算量较大的问题,提出将运动规律无因次化,获得不同运动规律的最大速度和加速度等参数,根据最大速度和加速约束,快速计算轨迹时间。在一个插补周期内所有关节轴的位移、速度等参数采用同一计算公式,减少因关节轴数的增加带来的轨迹运算量成倍的增长问题,减小计算量。
机械臂的硬件采用STM32F407VET6单片机作为控制器,设计了步进电机驱动、矩阵按键、LCD显示器的硬件电路,并进行了软件编程。经实验验证,所设计的机械臂建模及运动学求解准确无误,运动轨迹快速平稳,满足创客教育在教学过程的要求。