两自由度变曲柄五杆驱动机构形成移栽轨迹的设计方法技术

本发明专利技术公开了一种两自由度变曲柄五杆驱动机构形成移栽轨迹的设计方法。现有移栽机构轨迹不适用于花卉移栽。本发明专利技术的具体步骤如下：首先构建变曲柄五杆驱动机构，建立第二连杆的自由端端点形成双环扣轨迹的数学模型；然后通过所建立的数学模型反求出第一曲柄的长度变化规律，求出滑套在第一曲柄上的滑动速度；最后校验变曲柄五杆驱动机构是否满足双曲柄的存在条件。本发明专利技术采用变曲柄五杆驱动机构，实现双环扣轨迹，不仅可以实现花卉的移栽轨迹，并且可以实现瓜果、蔬菜、花卉等多种作物的全自动移栽。

【技术实现步骤摘要】
两自由度变曲柄五杆驱动机构形成移栽轨迹的设计方法
本专利技术属于农业机械领域，涉及花栽轨迹的设计方法，具体涉及一种两自由度变曲柄五杆驱动机构形成移栽轨迹的设计方法。
技术介绍
机械化移栽一般分为两步完成：取苗和栽植。按不同的取苗方式将移栽机分为全自动和半自动两种方式，关键标志是看其是否采用机械化取苗作业。目前旱地移栽机械式取苗方式一般有夹土式取苗和夹苗式取苗两种方式。新型行星轮系旋转式取苗机构有混合高阶变型椭圆齿轮行星系钵苗移栽机分秧机构、自由二阶非圆齿轮行星系高速钵苗移栽机构和旋转式水稻钵苗移栽机构，它们取苗方式为夹土式取苗，即需要秧针进入钵苗盘内夹取秧苗，且不能破坏钵盘和伤根，故轨迹需要一个尖锐的突起，从秧针进入钵盘到完全离开钵体，秧针需要一段接近于直线的运动轨迹，由于这个限制，造成了非圆齿轮不规则性增强或增加“探出式”秧针，机构力学性能变差、寿命降低。当前研究的移栽机构轨迹包括‘D’形轨迹，‘P’形轨迹，‘8’字形轨迹，但考虑到花卉移栽需完成从穴盘往花盘中的移栽工作，现有的轨迹方案均不适合。双曲柄机构、行星齿轮机构只能形成一个环扣状轨迹，不能实现双环扣状轨迹，难以保证以更好的姿态进入植苗工作部分和实现花卉移栽机的全自动化，为了解决这个难题，需要在植苗机构部分也设计一个环扣状轨迹来满足花卉移栽轨迹要求。对于基质育苗移栽，基质较轻，而部分瓜果、蔬菜、花卉作物的茎秆部分足够坚韧，允许采用夹苗的方式作业。因此，有必要针对瓜果、蔬菜、花卉等作物，设计一种效率更高、传动更平稳的取苗机构，使其与植苗机构配合，实现瓜果、蔬菜、花卉等作物的全自动移栽。
技术实现思路
本专利技术的目的是针对现有技术的不足，提供一种两自由度变曲柄五杆驱动机构形成移栽轨迹的设计方法，该方法首先构建变曲柄五杆驱动机构，建立第二连杆的自由端端点形成双环扣轨迹的数学模型；然后通过所建立的数学模型反求出第一曲柄的长度变化规律，求出滑套在第一曲柄上的滑动速度；最后校验变曲柄五杆驱动机构是否满足双曲柄的存在条件。该方法采用变曲柄五杆驱动机构，实现双环扣轨迹，从而实现取苗和植苗动作，不仅可以实现花卉的移栽轨迹，并且可以实现瓜果、蔬菜、花卉等多种作物的全自动移栽。为解决上述技术问题，本专利技术的技术方案是：本专利技术的具体步骤如下：步骤一、构建变曲柄五杆驱动机构。所述的变曲柄五杆驱动机构，包括第一曲柄、第一连杆、第二曲柄、第二连杆、滑套、旋转电机和直线电机；所述第一曲柄的一端与机架铰接，另一端与滑套通过滑动副连接；所述第一连杆的一端与滑套铰接，另一端与第二连杆的一端铰接；所述第二曲柄的一端与机架铰接，另一端与第二连杆的中部铰接；第二连杆的另一端自由设置；旋转电机驱动第一曲柄以角速度ω1匀速转动，直线电机驱动滑套以速度V1在第一曲柄上滑动，第二连杆的自由端端点处形成双环扣轨迹。步骤二、基于三次非均匀B样条曲线建立第二连杆的自由端端点处的双环扣轨迹数学模型。选取十一个数据点q0、q1、q2、q3、q4、q5、q6、q7、q8、q9和q10作为三次非均匀B样条曲线的型值点，其中，q0和q10重合，可唯一求解到十三个控制顶点，再选取步长为0.005～0.02中的一个值插值生成拟合点坐标，进而拟合出双环扣轨迹。所述双环扣轨迹的曲线方程为φ(t)，φ(t)在水平方向和竖直方向的位移方程分别为φx(t)和φy(t)。所述的双环扣轨迹为封闭且带有两个环扣的平面圆滑曲线，包括依次顺序首尾连接的入钵段、取苗段、运苗段、植苗段和回复段；取苗段的起始段为q1与q3之间的曲线段；植苗段的起始段为q4与q5之间的曲线段；入钵段为取苗段的过渡段。步骤三、第一曲柄的角速度ω1取一个定值，通过双环扣轨迹数学模型反求出第一曲柄的长度变化规律。构造函数如下：式(1)中，φ1为第一曲柄与水平面的初始夹角，φ2为第一连杆在t时刻与水平面的夹角，β为第二连杆在t时刻与水平面的夹角；L2为第一连杆的长度，L5为第一连杆与第二连杆的铰接点至第二曲柄与第二连杆的铰接点之间的距离，L6为第二曲柄与第二连杆的铰接点至第二连杆的自由端端点之间的距离；φ1′为中间变量；可由式(1)求出第一曲柄的长度L1的变化规律：L1＝G[φx(t),φy(t)](2)步骤四、求解滑套在第一曲柄上的滑动速度V1：V1＝G′[φx(t),φy(t)](3)步骤五、校验变曲柄五杆驱动机构是否满足双曲柄的存在条件：式(4)中，L3为第一曲柄与机架的铰接点至第二曲柄与机架的铰接点之间的距离。由花卉移栽农艺要求选取的十一个数据点如下：q0和q10确定双环扣轨迹的最高点，q1确定双环扣轨迹的取苗开始点，q4确定双环扣轨迹的最低点，q5确定双环扣轨迹的植苗结束点，q2、q3、q4和q6是影响栽植嘴退出垄面时轨迹姿态的关键点，q7、q8和q9是双环扣轨迹的辅助拟合点。所述取苗段的起始段平行于穴盘盘口下侧壁且直线度为1mm/10mm；植苗段的起始段竖直设置且直线度为1mm/10mm。本专利技术的有益效果：1、通过变曲柄五杆驱动机构实现的移栽轨迹满足钵苗移栽机平入钵、直拔苗、稳投苗的移栽农艺要求；机构简单，使得取苗和植苗的动作更加灵活，柔度高，从而实现花卉、瓜果、蔬菜等作物的全自动移栽，为实现移栽机械通用化取得了突破。2、双环扣轨迹，不仅可以实现取苗动作，也可以实现植苗动作，从而实现移栽机的全自动化；另外植苗机构部分的环扣状轨迹不仅可以保证花卉垂直下落进入植苗机构，还可以保证投苗时合适的角度、速度、植苗的直立度，从而更好地满足移栽的农艺要求。3、采用变曲柄五杆驱动机构，使得取苗轨迹更利于机构实现，既可以实现水平和竖直方向的综合位移，又可以分别实现单方向位移，变曲柄五杆驱动机构的自由度恰好满足移栽机所需运动轨迹的自由度数量。4、机构结构简单、紧凑、灵活度高，可以轻松实现各种农作物移栽所需运动轨迹的要求。附图说明图1为本专利技术的变曲柄五杆驱动机构在初始位置的机构简图。图2为本专利技术在移栽中实现的双环扣轨迹图。具体实施方式下面结合附图和实施例对本专利技术作进一步说明。两自由度变曲柄五杆驱动机构形成移栽轨迹的设计方法，具体步骤如下：步骤一、构建变曲柄五杆驱动机构。如图1所示，变曲柄五杆驱动机构，包括第一曲柄1、第一连杆2、第二曲柄4、第二连杆5、滑套6、旋转电机和直线电机；第一曲柄1的一端与机架3铰接，另一端与滑套6通过滑动副连接；第一连杆2的一端与滑套6铰接，另一端与第二连杆5的一端铰接；第二曲柄4的一端与机架3铰接，另一端与第二连杆5的中部铰接；第二连杆5的另一端自由设置；旋转电机驱动第一曲柄1以角速度ω1匀速转动，直线电机驱动滑套6以速度V1在第一曲柄1上滑动，第二连杆5的自由端本文档来自技高网...

【技术保护点】
两自由度变曲柄五杆驱动机构形成移栽轨迹的设计方法，其特征在于：该方法的具体步骤如下：步骤一、构建变曲柄五杆驱动机构；所述的变曲柄五杆驱动机构，包括第一曲柄、第一连杆、第二曲柄、第二连杆、滑套、旋转电机和直线电机；所述第一曲柄的一端与机架铰接，另一端与滑套通过滑动副连接；所述第一连杆的一端与滑套铰接，另一端与第二连杆的一端铰接；所述第二曲柄的一端与机架铰接，另一端与第二连杆的中部铰接；第二连杆的另一端自由设置；旋转电机驱动第一曲柄以角速度ω1匀速转动，直线电机驱动滑套以速度V1在第一曲柄上滑动，第二连杆的自由端端点处形成双环扣轨迹；步骤二、基于三次非均匀B样条曲线建立第二连杆的自由端端点处的双环扣轨迹数学模型；选取十一个数据点q0、q1、q2、q3、q4、q5、q6、q7、q8、q9和q10作为三次非均匀B样条曲线的型值点，其中，q0和q10重合，可唯一求解到十三个控制顶点，再选取步长为0.005～0.02中的一个值插值生成拟合点坐标，进而拟合出双环扣轨迹；所述双环扣轨迹的曲线方程为φ(t)，φ(t)在水平方向和竖直方向的位移方程分别为φx(t)和φy(t)；所述的双环扣轨迹为封闭且带有两个环扣的平面圆滑曲线，包括依次顺序首尾连接的入钵段、取苗段、运苗段、植苗段和回复段；取苗段的起始段为q1与q3之间的曲线段；植苗段的起始段为q4与q5之间的曲线段；入钵段为取苗段的过渡段；步骤三、第一曲柄的角速度ω1取一个定值，通过双环扣轨迹数学模型反求出第一曲柄的长度变化规律；构造函数如下：L1cosφ1′+L2cosφ2+(L5+L6)cosβ=φx(t)L1sinφ1′+L2sinφ2+(L5+L6)sinβ=φy(t)φ1′=φ1+ω1×t---(1)]]>式(1)中，φ1为第一曲柄与水平面的初始夹角，φ2为第一连杆在t时刻与水平面的夹角，β为第二连杆在t时刻与水平面的夹角；L2为第一连杆的长度，L5为第一连杆与第二连杆的铰接点至第二曲柄与第二连杆的铰接点之间的距离，L6为第二曲柄与第二连杆的铰接点至第二连杆的自由端端点之间的距离；φ′1为中间变量；可由式(1)求出第一曲柄的长度L1的变化规律：L1＝G[φx(t),φy(t)]  (2)步骤四、求解滑套在第一曲柄上的滑动速度V1：V1＝G′[φx(t),φy(t)]  (3)步骤五、校验变曲柄五杆驱动机构是否满足双曲柄的存在条件：L1≤L2+L5-L3-L4L1≤L5+L3-L2-L4L1≤L2+L3-L4-L5---(4)]]>式(4)中，L3为第一曲柄与机架的铰接点至第二曲柄与机架的铰接点之间的距离。...

【技术特征摘要】
1.两自由度变曲柄五杆驱动机构形成移栽轨迹的设计方法，其特征在于：该方法的具体步骤如下：步骤一、构建变曲柄五杆驱动机构；所述的变曲柄五杆驱动机构，包括第一曲柄、第一连杆、第二曲柄、第二连杆、滑套、旋转电机和直线电机；所述第一曲柄的一端与机架铰接，另一端与滑套通过滑动副连接；所述第一连杆的一端与滑套铰接，另一端与第二连杆的一端铰接；所述第二曲柄的一端与机架铰接，另一端与第二连杆的中部铰接；第二连杆的另一端自由设置；旋转电机驱动第一曲柄以角速度ω1匀速转动，直线电机驱动滑套以速度V1在第一曲柄上滑动，第二连杆的自由端端点处形成双环扣轨迹；步骤二、基于三次非均匀B样条曲线建立第二连杆的自由端端点处的双环扣轨迹数学模型；选取十一个数据点q0、q1、q2、q3、q4、q5、q6、q7、q8、q9和q10作为三次非均匀B样条曲线的型值点，其中，q0和q10重合，可唯一求解到十三个控制顶点，再选取步长为0.005～0.02中的一个值插值生成拟合点坐标，进而拟合出双环扣轨迹；所述双环扣轨迹的曲线方程为φ(t)，φ(t)在水平方向和竖直方向的位移方程分别为φx(t)和φy(t)；所述的双环扣轨迹为封闭且带有两个环扣的平面圆滑曲线，包括依次顺序首尾连接的入钵段、取苗段、运苗段、植苗段和回复段；取苗段的起始段为q1与q3之间的曲线段；植苗段的起始段为q4与q5之间的曲线段；入钵段为取苗段的过渡段；步骤三、第一曲柄的角速度ω1取一个定值，通过双环扣轨迹数学模型反求出第一曲柄的长度变化规律；构造函数如下：

【专利技术属性】
技术研发人员：赵雄，代丽，陈建能，
申请(专利权)人：浙江理工大学，
类型：发明
国别省市：浙江;33