Week 16 阿威的課堂筆記

1.使用內插公式讓機器人動的順暢：

2.寫檔：
if(key=='s')
    {
        if(fout==NULL)
        {
            fout=fopen("file.txt","w+");
        }
        fprintf(fout,"%.2f %.2f %.2f %.2f %.2f\n",angle[0],angle[1],angle[2],angle[3],angle[4]);
        printf("%.2f %.2f %.2f %.2f %.2f\n",angle[0],angle[1],angle[2],angle[3],angle[4]);
    }
3.讀檔：
if(key=='r')
    {
        //PlaySound("C:\\Users\\Home\\Desktop\\04160613-robot2.0\\04160613-robot2.0\\04160613\\data\Linkin Park - New Divide.mp3",NULL,SND_ASYNC);
        if(fin==NULL)
        {
            fin=fopen("file.txt","r");
            fscanf(fin,"%f %f %f %f %f\n",&newangle[0],&newangle[1],&newangle[2],&newangle[3],&newangle[4]);
        }
        if(alpha>=1.0)
        {
            for(int i=0;i<5;i++)oldangle[i]=newangle[i];
            fscanf(fin,"%f %f %f %f %f\n",&newangle[0],&newangle[1],&newangle[2],&newangle[3],&newangle[4]);
            alpha=0.0;
        }
        for(int i=0;i<5;i++)
        {
            angle[i]=alpha*newangle[i]+(1-alpha)*oldangle[i];
        }
        alpha+=0.02;
        //fscanf(fin,"%f %f %f %f %f\n",&angle[0],&angle[1],&angle[2],&angle[3],&angle[4]);
        printf("%.2f %.2f %.2f %.2f %.2f\n",angle[0],angle[1],angle[2],angle[3],angle[4]);
        glutPostRedisplay();
    }