2014年5月30日 星期五

機器的路3(最終章)

經歷過各種進化難題,我們可愛的小機器人..的夥伴茶壺君終於可以順順的動了!
為了慶祝這一刻以及迎接最終試煉的到來,讓我們收下這長長的程式碼吧!
機器人可以和茶壺君通過最終試煉嗎   讓我們繼續看下去

#include <stdio.h>
#include <GL/glut.h>

float a=0;//內差值比重 
float angle[20]={0,90,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
float angleNew[20]={0,90,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
float angleOld[20]={90,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
int angleID =0; //關節維骨力 
FILE * fout=NULL, *fin=NULL;
//宣告讀檔囉 (在readnext裡面使用)

void readNext()
{
if(fin==NULL) fin=fopen("Position","r");//讀檔 
a+=0.1;
for(int i=0;i<20;i++) angle[i] = angleOld[i]*(1-a) + angleNew[i]*a ;
if(a>=1.0){
a=0.0;
for(int i=0; i<20 ; i++){
angleOld[i] = angleNew[i];
fscanf(fin,"%f ",&angleNew[i]);
}
}

}
void timer(int t)//計時器 
{
glutTimerFunc(100,timer,0);
readNext();
glutPostRedisplay();
}
int OldX=0, OldY=0;//mouse X , mouse Y
void mouse(int button, int state, int x, int y)//滑鼠移動(拍影片時記點使用之最佳良伴) 
{
OldX=x; OldY=y;
}
void motion(int x, int y)
{
angle[angleID]+= (x-OldX);
OldX=x;
glutPostRedisplay();
}

void keyboard(unsigned char key, int x, int y)//鍵盤移動(其實鍵盤的作用比較偏向輔助滑鼠) 
{
if(key=='0')angleID=0;
if(key=='1')angleID=1;
if(key=='2')angleID=2;
if(key=='3')angleID=3;
if(key=='s'){/*save*/
if(fout==NULL) fout=fopen("Position","w+");
for(int i=0;i<20;i++){
printf( "%f",angle[i]);//寫在小黑 
fprintf(fout,"%f",angle[i]);//寫在NOTE
}
printf( "\n");//同上 
fprintf(fout,"\n");
}
if(key=='r'){ readNext(); }//鍵盤移動用 
if(key=='p'){ glutTimerFunc(0,timer,0); }//滑鼠移動動畫用 
glutPostRedisplay();
}
void display()
{
glClear(GL_COLOR_BUFFER_BIT|GL_DEPTH_BUFFER_BIT);
glPushMatrix();
glRotatef(angle[0],0,0,1);
glutSolidTeapot(0.3);
glPopMatrix();
glPushMatrix();
glTranslatef(0.5,0,0);
glRotatef(angle[1],0,0,1);
glutSolidTeapot(0.3);
glPopMatrix();
glutSwapBuffers();
}
int main()
{
glutInitDisplayMode(GLUT_DOUBLE|GLUT_DEPTH);
glutCreateWindow("week15");
glutDisplayFunc(display);
glutKeyboardFunc(keyboard);
glutMouseFunc(mouse);
glutMotionFunc(motion);
glutMainLoop();
}

沒有留言:

張貼留言