c++ eigen 简单用法
来源:互联网 发布:手机自动充值软件 编辑:程序博客网 时间:2024/06/06 08:38
//{
// bool left_foot_contact = NCGetContactState(index, i, 6);
// bool right_foot_contact = NCGetContactState(index, i, 3);
// cout << right_foot_contact << endl;
// if (right_foot_contact == true)
// {
// float * getx = NCGetX(index, i);
// float * get_posi_in_ned = NCGetPosiInNED(index, i, 6);
// cout << getx[6 * 6 + 0] << "\t" << getx[6 * 6 + 1] << "\t" << getx[6 * 6 + 2] << endl;
// cout << getx[3 * 6 + 0] << "\t" << getx[3 * 6 + 1] << "\t" << getx[3 * 6 + 2] << endl;
// //cout << get_posi_in_ned[0] << "\t" << get_posi_in_ned[1] << "\t" << get_posi_in_ned[2] << endl;
// }
//}
//method1
//Eigen::Quaternionf q_s = { arm_q_start[0], arm_q_start[1], arm_q_start[2], arm_q_start[3] };
//Eigen::Quaternionf q_e = { arm_q_end[0], arm_q_end[1], arm_q_end[2], arm_q_end[3] };
//Eigen::Quaternionf q_res = q_s * q_e;
//Eigen::Vector3f euler_angles = q_res.matrix().eulerAngles(1, 0, 2); // YXZ
//Eigen::Vector3f euler_angels_new = euler_angles * 180.0f / 3.14159265;
//cout << euler_angels_new << endl;
//method2
/* Eigen::Quaternionf q_e = { arm_q_end[0], arm_q_end[1], arm_q_end[2], arm_q_end[3] };
Eigen::Vector3f ned_vector = { 0,0,1 };
cout << q_e.matrix().col(0) << endl;
float a = acos(q_e.matrix().col(0).dot(ned_vector)) * 180.0f / 3.14159265;
cout << a << endl;*/
Eigen::Matrix3f aa(3, 3),BB(3,6), cc(3,6);
aa.setZero();
BB.setZero();
cc.setZero();
aa = q.matrix();
BB = aa.inverse();
cc = q.matrix().inverse() * BB;
cout << cc << endl;
- Eigen的简单用法
- c++ eigen 简单用法
- Eigen的简单用法
- C++ Eigen的简单用法
- Eigen:矩阵计算简单用法(一)
- Eigen:矩阵计算简单用法(二)
- Eigen: C++开源矩阵计算工具——Eigen的简单用法
- Eigen: C++开源矩阵计算工具——Eigen的简单用法
- Eigen: C++开源矩阵计算工具——Eigen的简单用法
- Eigen: C++开源矩阵计算工具——Eigen的简单用法
- Eigen: C++开源矩阵计算工具——Eigen的简单用法
- Eigen: C++开源矩阵计算工具——Eigen的简单用法
- Eigen: C++开源矩阵计算工具——Eigen的简单用法
- Eigen: C++开源矩阵计算工具——Eigen的简单用法
- Eigen: C++开源矩阵计算工具——Eigen的简单用法
- Eigen: C++开源矩阵计算工具——Eigen的简单用法
- Eigen: C++开源矩阵计算工具——Eigen的简单用法
- Eigen: C++开源矩阵计算工具——Eigen的简单用法
- ECharts2.0柱状图横向显示
- Java方法的可变参数类型
- 数字证书的申请
- 协方差矩阵
- Kerberos hadoop常见问题汇总
- c++ eigen 简单用法
- 春风十里不如你--Angularjs 中的iframe 标签 ng-src 路径
- java toString()和String.valueOf() 和(String)object区别
- read
- VUE 学习笔记 从零开始一步一步构建 VUE 单页应用(四)
- 在Eclipse使用BASE64Decoder的心得
- easyui的datagrid中一些用法
- angular2到angular4的过度
- Java——JDK内置日志