hdu4087ALetter to Programmers(三维旋转矩阵)
三维旋转矩阵 + 矩阵加速
这个还要用到仿射变换。
平移
#include <iostream>
#include<cstdio>
#include<cstring>
#include<algorithm>
#include<stdlib.h>
#include<vector>
#include<cmath>
#include<queue>
#include<set>
using namespace std;
#define N 1010
#define LL long long
#define INF 0xfffffff
#define forn(i,n) for(int i=0; i<(int)(n); i++)
const double eps = 1e-;
const double pi = acos(-1.0);
const double inf = ~0u>>; struct point3
{
double x,y,z;
} p[N];
struct Mat
{
double mat[][];
};
int n,m;
char str[];
Mat operator * (Mat a,Mat b)
{
Mat c;
memset(c.mat,,sizeof(c.mat));
int i,j,k;
for(i = ; i < n ; i++)
for(j = ; j < n ; j++)
for(k = ; k < n ; k++)
c.mat[i][j] +=a.mat[i][k]*b.mat[k][j];
return c;
}
Mat operator ^(Mat a,int k)
{
Mat c; int i,j;
for(i = ; i < n ; i++)
for(j = ; j < n ; j++)
c.mat[i][j] = (i==j);
for(; k ; k >>= )
{
if(k&) c = c*a;
a = a*a;
}
return c;
}
Mat solve(int k)
{ Mat cc;
double a[];
int i;
memset(cc.mat,,sizeof(cc.mat));
for(i = ; i < ; i++) cc.mat[i][i] = ;
while(~scanf("%s",str))
{
if(str[]=='e')
{
break;
}
Mat c;
memset(c.mat,,sizeof(c.mat));
for(i = ; i < ; i++) c.mat[i][i] = ;
if(str[]=='t')
{
forn(i,) scanf("%lf", &a[i]);
forn(i,) c.mat[i][]=a[i];
}
else if(str[]=='s')
{
for(i = ; i < ; i++)
scanf("%lf",&a[i]);
for(i = ; i < ; i++)
c.mat[i][i] = a[i];
}
else if(str[]=='r'&&str[]=='o')
{
for(i = ; i < ; i++) scanf("%lf",&a[i]);
a[] = a[]/*pi;
double mag=sqrt(a[]*a[]+a[]*a[]+a[]*a[]);
a[]/=mag;
a[]/=mag;
a[]/=mag;
c.mat[][] = (-cos(a[]))*a[]*a[]+cos(a[]);
c.mat[][] = (-cos(a[]))*a[]*a[]-sin(a[])*a[];
c.mat[][] = (-cos(a[]))*a[]*a[]+sin(a[])*a[];
c.mat[][] = (-cos(a[]))*a[]*a[]+sin(a[])*a[];
c.mat[][] = (-cos(a[]))*a[]*a[]+cos(a[]);
c.mat[][] = (-cos(a[]))*a[]*a[]-sin(a[])*a[];
c.mat[][] = (-cos(a[]))*a[]*a[]-sin(a[])*a[];
c.mat[][] = (-cos(a[]))*a[]*a[]+sin(a[])*a[];
c.mat[][] = (-cos(a[]))*a[]*a[]+cos(a[]);
}
else if(str[]=='r')
{
int kk ;
scanf("%d",&kk);
c = solve(kk);
}
cc = c*cc;
}
return cc^k;
}
int dcmp(double x)
{
if(fabs(x)<eps) return ;
return x<?-:;
}
int main()
{
int i,j;
n = ;
while(scanf("%d",&m)&&m)
{
Mat c;
memset(c.mat,,sizeof(c.mat));
for(i = ; i < n; i++) c.mat[i][i] = ;
c = solve()*c;
for(i = ; i <= m; i++)
{
Mat x,y;
memset(y.mat,,sizeof(y.mat));
for(j = ; j < ; j++)
scanf("%lf",&y.mat[j][]);
y.mat[][] = ;
x = c*y;
p[i].x = x.mat[][],p[i].y = x.mat[][],p[i].z = x.mat[][];
}
for(i = ; i <= m; i++)
{
printf("%.2f %.2f %.2f\n",p[i].x+eps,p[i].y+eps,p[i].z+eps);
}
puts("");
}
return ;
}
hdu4087ALetter to Programmers(三维旋转矩阵)的更多相关文章
- 三维卷积:全景图像Spherical CNNs(Code)
卷积神经网络(CNN)可以很好的处理二维平面图像的问题.然而,对球面图像进行处理需求日益增加.例如,对无人机.机器人.自动驾驶汽车.分子回归问题.全球天气和气候模型的全方位视觉处理问题. 将球形信号的 ...
- 深入理解图优化与g2o:图优化篇
前言 本节我们将深入介绍视觉slam中的主流优化方法——图优化(graph-based optimization).下一节中,介绍一下非常流行的图优化库:g2o. 关于g2o,我13年写过一个文档,然 ...
- 四轴飞行器1.1 Matlab 姿态显示
四轴飞行器1.1 Matlab 姿态显示 开始做四轴了,一步一步来,东西实在很多,比较杂.先做matlab上位机,主要用来做数据分析,等板子到了可以写飞控的程序了,从底层一层一层开始写..希望能好好的 ...
- PostScript学习:另一种缩写为PS的技术
1.前言 PostScript是一种编程语言,直译为"后处理脚本"[相对印刷过程而言],学名为页面描述语言.更为详细的解释见维基百科,以及其翻译版百度百科. 值得一提的是,Post ...
- Three.js 学习笔记(1)--坐标体系和旋转
前言 JavaScript 3D library The aim of the project is to create an easy to use, lightweight, 3D library ...
- 相机标定问题-Matlab & Py-Opencv
一.相机标定基本理论 1.相机成像系统介绍 图中总共有4个坐标系: 图像坐标系:Op 坐标表示方法(u,v) Unit:Dots(个) 成像坐标系:Oi ...
- SLAM学习笔记 - 世界坐标系到相机坐标系的变换
参考自: http://blog.csdn.net/yangdashi888/article/details/51356385 http://blog.csdn.net/li_007/article/ ...
- 高翔《视觉SLAM十四讲》从理论到实践
目录 第1讲 前言:本书讲什么:如何使用本书: 第2讲 初始SLAM:引子-小萝卜的例子:经典视觉SLAM框架:SLAM问题的数学表述:实践-编程基础: 第3讲 三维空间刚体运动 旋转矩阵:实践-Ei ...
- 《SLAM十四讲》个人学习知识点梳理
0.引言 从六月末到八月初大概一个月时间一直在啃SLAM十四讲[1]这本书,这本书把SLAM中涉及的基本知识点都涵盖了,所以在这里做一个复习,对这本书自己学到的东西做一个梳理. 书本地址:http:/ ...
随机推荐
- sed
命令行格式为: sed [-nefri] ‘command’ 输入文本/文件 常用选项: -n∶取消默认的输出,使用安静(silent)模式.在一般 sed 的用法中 ...
- 浅谈大型web系统架构
动态应用,是相对于网站静态内容而言,是指以c/c++.php.Java.perl..net等服务器端语言开发的网络应用软件,比如论坛.网络相册.交友.BLOG等常见应用.动态应用系统通常与数据库系统. ...
- SQL中EXISTS的用法
比如在Northwind数据库中有一个查询为SELECT c.CustomerId,CompanyName FROM Customers cWHERE EXISTS(SELECT OrderID FR ...
- debian的版本演进
debian有三个发行版本,stable版.testing版和unstable版. 其中,unstable版本是开发者正在开发的版本,它里面保存着debian的开发者当前的工作.这个版本是不断在被更新 ...
- select in 在postgresql的效率问题
在知乎上看到这样一个问题: MySQL 查询 select * from table where id in (几百或几千个 id) 如何提高效率?修改 电商网站,一个商品属性表,几十万条记录,80M ...
- AngularJs--angular-pagination可复用的分页指令
1.angular-pagination 是基于angular 编写的可复用分页指令 安装 克隆项目到本地: git clone https://github.com/febobo/angular-p ...
- 在ie与火狐的兼容性
1.在火狐下 document.getElementById("id").textContent可以获取当前获取id下的内容 而在ie下则为:document.getElem ...
- [转]Google Guava官方教程(中文版)
Google Guava官方教程(中文版) http://ifeve.com/google-guava/
- JNI ReferenceTable overflow
今天在小米设备上遇到如下问题 10-15 17:04:36.899: W/dalvikvm(2767): ReferenceTable overflow (max=512) 10-15 17:04:3 ...
- How to convert webp to png/jpg/gif in MacOS
Environment I'm using OS X 10.11.4 and have homebrew 1.0.5 installed. Introduction I recently downlo ...