IK(反向动力学)简单原理与实现

这篇具有很好参考价值的文章主要介绍了IK(反向动力学)简单原理与实现。希望对大家有所帮助。如果存在错误或未考虑完全的地方,请大家不吝赐教,您也可以点击"举报违法"按钮提交疑问。

IK(反向动力学)

反向运动学 (IK) 是一种设置动画的方法,它翻转链操纵的方向。它是从叶子而不是根开始进行工作的。

要了解 IK 是如何进行工作的,首先必须了解层次链接和正向运动学的原则。

简单演示

现在举个手臂的例子。要设置使用正向运动学的手臂的动画,可以旋转大臂使它移离肩膀,然后旋转小臂,手部等等,为每个子对象添加旋转关键点。

要设置使用反向运动学的手臂的动画,可以移动用以定位腕部的目标。手臂的上半部分和下半部分为 IK 解决方案所旋转,使称为末端效应器的腕部轴点向着目标移动。

IK(反向动力学)简单原理与实现
根、茎、叶(点)
IK(反向动力学)简单原理与实现
CCD 末端效应器运动
IK(反向动力学)简单原理与实现
CCD 蒙皮后
  • 反向运动学定义为确定一组适当的关节构型,使末端尽可能平稳、快速、准确地移动到所需位置的问题。
  • 是一种通过估计每个独立自由度来计算姿态的方法,以满足用户约束的给定任务。

反向动力学的实现方法有很多种,常见的有 CCD(循环坐标下降法),FABR(前向和后向法),本文只说明反向动力学的基本方法。

策略思路

1.从最小子骨骼开始遍历并趋近目标
2.每个骨骼都将其子骨骼的轴点作为跟随点(最小子骨骼无子节点需直接跟随目标点),开始趋近
3.骨骼跟随方法为,以自身轴点与目标点的方向为骨骼变换方向,并将骨骼终点与目标点对齐

从目标点(X)开始求解,并从链式结构的“叶节点”到“根节点”逐渐将整个链式结构趋近目标位置。

范例:
构建链式结构:[P2,P1]、[P3,P2]、[P4,P3],其长度分别为d1,d2,d3
(A)从尾端开始,以[P4,P3]开始逼近 X点,
(B)d3趋近,连接[P3, X], 将[P4,P3]移动至[P4‘,P3’],P4’ == X
(C)d2趋近,连接[P2, P3’],将[P3,P2]移动至[P3’,P2’]
(D)d1趋近,连接[P1, P2’],将[P2,P1]移动至[P2’,P1‘] IK(反向动力学)简单原理与实现
IK(反向动力学)简单原理与实现

角度限制

特殊情况下,得到运动的形状还不够,还需要进行一定的运动限制,现实中每一根骨骼在运动的过程中往往都会受到铰连接,带来的运动角度限制!

在链式结构跟随目标点运动时每个骨骼的运动角度都是相对的,即每个骨骼的角度限制都是以其子骨骼为相对方向(与子骨骼世界方向相同时角度为0°,相反时为180°或-180°),那么自然叶子节点因为没有子骨骼就没有什么限制(你要想有的话也可以有的,我这里不做实现)。

下图:
a为父骨骼,b 为子骨骼,那么,a的限制角度计算方式就为,a方向 旋转到 b方向 的角度为准,范围为(-180,180),角度的限制在跟随的过程中计算即可。
IK(反向动力学)简单原理与实现

实现代码:

Segment 类

    public class Segment
    {
        public float len;           //线段长度
        public Vector2 angleLimt = new Vector2(-180f, 180f);        //角度限制范围


        public Color color = Color.white;       //Gizmo color

        public Vector2 a { get; private set; }      //线段起点
        public Vector2 b { get; private set; }      //线段终点
        public Vector2 forward { get { return (b - a).normalized; } }       //线段终点方向

        /// <summary>
        /// 跟随目标节点,并计算自身位置
        /// </summary>
        /// <param name="target">目标点位置</param>
        /// <param name="prevDir">上一线段的方向</param>
        /// <param name="limt">是否使用角度限制</param>
        /// <param name="isForward">是否将线段终点作为向前方向</param>
        public void Follow(Vector2 target, Vector2 prevDir, Vector2 limt, bool isForward = true)
        {
            if (isForward)
            {
                a = -(target - a).normalized * len + target;
                b = target;
            }
            else
            {
                a = target;
                b = -(target - b).normalized * len + target;
            }

            if (limt.x != -180 || limt.y != 180) LimtAngle(prevDir, limt, isForward);
        }

        /// <summary>
        /// 角度限制
        /// </summary>
        /// <param name="prevDir">上一线段的方向</param>
        /// <param name="limt">角度的限制范围</param>
        /// <param name="isForward">是否将线段终点作为向前方向</param>
        private void LimtAngle(Vector2 prevDir, Vector2 limt, bool isForward = true)
        {
            float angle = Vector2.SignedAngle(prevDir, forward);
            if (isForward)
            {
                if (-angle < limt.x)
                {
                    a = -Rotate(prevDir, -limt.x) * len + b;
                }
                else if (-angle > limt.y)
                {
                    a = -Rotate(prevDir, -limt.y) * len + b;
                }
            }
            else
            {
                if (angle < limt.x)
                {
                    b = Rotate(prevDir, limt.x) * len + a;
                }
                else if (angle > limt.y)
                {
                    b = Rotate(prevDir, limt.y) * len + a;
                }
            }
        }
        /// <summary>
        /// 返回旋转后的角度
        /// </summary>
        /// <param name="v">normal</param>
        /// <param name="a">rad</param>
        private Vector2 Rotate(Vector2 v, float a)
        {
            a = a * Mathf.Deg2Rad + Mathf.Atan2(v.y, v.x);
            return new Vector2(Mathf.Cos(a), Mathf.Sin(a));
        }
    }

IKSolverSimp 类

    public class IKSolverSimp {

        public Segment[] segments = new Segment[] { };

        public Vector2 target;  //目标位置

        public bool useLimt = false;        //是否启用角度限制

        /// <summary>
        /// 以线段的起点为正方向,开始趋近目标
        /// </summary>
        public void CalculateForback()
        {
            segments[0].Follow(target, Vector2.zero, useLimt ? Vector2.zero : new Vector2(-180,180), false);
            for (int i = 1; i < segments.Length; i++)
            {
                segments[i].Follow(segments[i - 1].b, segments[i - 1].forward, useLimt ? segments[i].angleLimt : new Vector2(-180, 180), false);
            }
        }
        /// <summary>
        /// 以线段的终点为正方向,开始趋近目标
        /// </summary>
        public void CalculateForward()
        {
            segments[segments.Length - 1].Follow(target, Vector2.zero, useLimt ? Vector2.zero : new Vector2(-180, 180), true);
            for (int i = segments.Length - 2; i > -1; i--)
            {
                segments[i].Follow(segments[i + 1].a, segments[i + 1].forward, useLimt ? segments[i + 1].angleLimt : new Vector2(-180, 180), true);
            }
        }
    }

SimpIKTest 类

    public class SimpIKTest : MonoBehaviour
    {
        public IKSolverSimp iKSolverSimp;       //简单解算器

        public Transform targetP;       //目标点位置

        public bool useLimt = true;         //使用限制
        public bool update = false;         //实时更新
        public bool isHeadFollow = true;    //线段起点为正方向

        [Button("Calculate")]	//需要插件:Sirenix.OdinInspector;或替换为[ContextMenu("Calculate")]
        void Calculate()
        {
            iKSolverSimp.useLimt = useLimt;
            iKSolverSimp.target = targetP.position;
            if (isHeadFollow)
            {
                iKSolverSimp.CalculateForback();
            }
            else
            {
                iKSolverSimp.CalculateForward();
            }
        }

        private void OnDrawGizmos()
        {
            if (targetP == null) return;

            if (update) Calculate();

            Segment last = null;
            foreach (var item in iKSolverSimp.segments)
            {
                Gizmos.color = item.color;
                Mov.GizmeDrawArrow(item.a, item.b);

                if (useLimt && last != null)
                {
                    Mov.GizmeDrawCircleLimt(item.a, (item.b - item.a).normalized, item.angleLimt, 0, item.len / 4f, last.a);
                }
                last = item;
            }
        }
    }
public static class Mov{
	public static Vector2 Rotate(Vector2 v, float a)
    {
        Vector2 n = v.normalized;
        a += Mathf.Atan2(n.y, n.x);
        return new Vector2(Mathf.Cos(a),Mathf.Sin(a)) * v.magnitude;
    }
    public static void GizmeDrawArrow(Vector2 a, Vector2 b)
    {
        Vector2 dir = (a - b).normalized;
        float l = (a - b).magnitude * 0.2f;
        Vector2 u = Rotate(dir, 30 * Mathf.Deg2Rad) * l;
        Vector2 d = Rotate(dir, -30 * Mathf.Deg2Rad) * l;

        Gizmos.DrawLine(a, b);
        Gizmos.DrawLine(b, b + u);
        Gizmos.DrawLine(b, b + d);
    }
    public static void GizmeDrawCircleLimt(Vector2 anchor, Vector2 right, Vector2 limt, float angleOff, float len, Vector2 anchor2)
    {
        Vector2 dir = right * len;

        Vector2 a, b, c;
        a = anchor;
        b = a + Rotate(dir, -(limt.x + angleOff) * Mathf.Deg2Rad);
        c = a + Rotate(dir, -(limt.y + angleOff) * Mathf.Deg2Rad);

        Color green = new Color(0, 1, 1, .3f);
        Color blue = new Color(0, 0, 1, .3f);
        Color white = new Color(1, 1, 1, .3f);
        Color black = new Color(0, 0, 0, .3f);
        Gizmos.color = green;
        Gizmos.DrawLine(a, b);
        Gizmos.color = blue;
        Gizmos.DrawLine(a, c);

        Vector2 s = b - a;
        float rad = (limt.y - limt.x) * Mathf.Deg2Rad;
        for (float i = 0; i < 1f; i += 0.1f)
        {
            Gizmos.color = Color.Lerp(green, black, i);
            Gizmos.DrawLine(a + Mov.Rotate(s, -i * rad), a + Mov.Rotate(s, -(i + 0.1f) * rad));
        }
        if (anchor != anchor2)
        {
            Gizmos.color = white;
            Gizmos.DrawLine(a, a + (a - anchor2).normalized * len * 1.05f);
        }
    }
}

效果演示(角度限制与无限制)
IK(反向动力学)简单原理与实现文章来源地址https://www.toymoban.com/news/detail-407836.html

到了这里,关于IK(反向动力学)简单原理与实现的文章就介绍完了。如果您还想了解更多内容,请在右上角搜索TOY模板网以前的文章或继续浏览下面的相关文章,希望大家以后多多支持TOY模板网!

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处: 如若内容造成侵权/违法违规/事实不符,请点击违法举报进行投诉反馈,一经查实,立即删除!

领支付宝红包 赞助服务器费用

相关文章

  • 【现代机器人学】学习笔记七:开链动力学(前向动力学Forward dynamics 与逆动力学Inverse dynamics)

    这节的内容主要讲述机器人动力学的内容。相对于本书其他部分运动学内容相比,把动力学一下子合成了一章。看完以后有三个感受: 1.本章难度相对其他章节较大,因此需要反复去看,以求对重要内容的眼熟,不求全部记住,但只求说起某块内容时,心中有数。2.阅读时一

    2024年02月14日
    浏览(48)
  • 动力学约束下的运动规划算法——Hybrid A*算法(附程序实现及详细解释)

       前言(推荐读一下)    本文主要介绍动力学约束下的运动规划算法中非常经典的Hybrid A*算法,大致分为三部分,第一部分是在传统A * 算法的基础上,对Hybrid A * 算法的原理、流程进行理论介绍。第二部分是详细分析 MotionPlanning运动规划库中Hybrid A * 算法的源码,进一

    2024年02月08日
    浏览(59)
  • 二维离散动力学系统的混沌研究【基于matlab的动力学模型学习笔记_9】

    摘 要: 混沌(Chaos)是指发生在确定系统中的貌似随机的不规则运动,本文将基于经典的二维系统,然后根据动力学方程研究其混沌产生过程以及相对应的MATLAB仿真,再讨论Lyapunov指数以及正平衡点。 上一篇中介绍了一维系统,这次我们将维数提升到二。 /*仅当作学习笔记,

    2024年02月05日
    浏览(60)
  • 自动驾驶——车辆动力学模型

    A矩阵离散化 B矩阵离散化 反馈计算 前馈计算: 超前滞后反馈:steer_angle_feedback_augment 参考【运动控制】Apollo6.0的leadlag_controller解析 控制误差计算 横向距离误差计算 横向误差变化率计算 航向角误差计算 航向角误差变化率计算 参考:Apollo代码学习(三)—车辆动力学模型

    2024年02月12日
    浏览(57)
  • 盐构造发育的动力学机制

    盐构造可以由以下6 种机制触发引起(图 2)[18] :①浮力作用;②差异负载作用;③重力扩张作 用;④热对流作用;⑤挤压作用;⑥伸展作用。盐体 的塑性流动和非常规变形是盐构造的主要特点,岩 盐有时在几百m 深处就可以流动,这主要与盐的纯度、地温梯度和盐的干湿度等因

    2024年02月20日
    浏览(52)
  • 自动驾驶控制算法——车辆动力学模型

    考虑车辆 y 方向和绕 z 轴的旋转,可以得到车辆2自由度模型,如下图: m a y = F y f + F y r (2.1) ma_y = F_{yf} + F_{yr} tag{2.1} m a y ​ = F y f ​ + F yr ​ ( 2.1 ) I z ψ ¨ = l f F y f − l r F y r (2.2) I_zddotpsi = l_fF_{yf} - l_rF_{yr} tag{2.2} I z ​ ψ ¨ ​ = l f ​ F y f ​ − l r ​ F yr ​ ( 2.2 ) 经验公

    2024年01月18日
    浏览(58)
  • 旋翼无人机建模动力学公式整理

    C_T为升力系数,C_M为扭力系数,w为螺旋桨的转速 如果是‘十’字型的飞机 x,y,z轴的力矩为: d是机体中心到每个螺旋桨的距离,b是一个系数; f=Ct*W^2,Ct——升力系数,W——螺旋桨的转速 惯量矩阵为: 四个电机产生的力f1,f2,f3,f4,如果我们假设z轴向上为正,可以得到:

    2024年04月29日
    浏览(58)
  • 车辆运动学和动力学模型概述

    对车辆建立数字化模型,分为车辆运动学和动力学模型。 车辆运动学模型(Kinematic Model )把车辆完全视为刚体,主要考虑车辆的位姿(位置坐标、航向角)、速度、前轮转角等的关系,不考虑任何力的影响。 1.前提假设: 不考虑Z轴方向运动,默认车在二维平面上的运动 假设

    2024年02月13日
    浏览(51)
  • 观点动力学模型:主要理论与模型综述

    意见动态建模 1 n 1_n 1 n ​ :表示n维全为1的列向量 0 n 0_n 0 n ​ :表示n维全为0的列向量 I n I_n I n ​ :表示 n × n ntimes n n × n 的单位阵 e i e_i e i ​ :表示基单位向量,向量中除了第i个位置上为1外其余都为0 矩阵A为非负矩阵,意味着着其中所有的元素 a i j ≥ 0 a_{ij}≥0 a i

    2024年02月09日
    浏览(60)
  • 血流动力学与血压(一)--平均动脉压

      上图表示了心脏泵血循环和一个简单的电路的相似程度,图(a)表示了一个简单的电路,V1-V2是在电阻两点的电势差,I是流经电阻的电流,R是电阻的阻值。类比于图(a),图(b)中的 SVR(systemic vascular resistance) 表示的的是全身血管阻抗,P1-P2表示的是体循环两个端点之间的血压

    2024年02月10日
    浏览(47)

觉得文章有用就打赏一下文章作者

支付宝扫一扫打赏

博客赞助

微信扫一扫打赏

请作者喝杯咖啡吧~博客赞助

支付宝扫一扫领取红包,优惠每天领

二维码1

领取红包

二维码2

领红包