كشش در سي پلاس

سلام

من مي خوام يك در بكشم كه اين در باز و بسته بشه

نقاط در من اينها هستند :

کد:

---


float p[3][4]= {{150,200,200,150},{150,150,350,350},{1,1,1,1}};
class door
{
private:
 
public:
door();
void d_draw();
void d_shearing (float a , float b);
};
void door::door()
{
d_draw();
}
void door::d_draw()
{
for(float a = 0 ; a<3 ; a++)
line(p[0][a],p[1][a],p[0][a+1],p[1][a+1]);
}
void doop::d_shearing (float a , float b)
{ float st [3][3]={{1,a,p[1][0]*(-a)},{b,1,p[0][0]*(-b)},{0,0,1}};
float np[3][4];
for(int i=0 ; i<3 ; i++)
for (int j=0 ; j<3 ; j++)
{
np[i][j]=0;
for(int k=0 ; k<3 ; k++)
np[i][j]+=st[i][k]*p[k][j];
}
for(i=0 ; i<3 ; i++)
for(j=0 ; j<3 ; j++)
p[i][j]=np[i][j];
}

---

تابع searing من درست كار نمي كنه و يا اين كه من از اون درست استفاده نمي كنم
من در main اين طوري مي نويسم

کد:

---


door d;
while (!kbhit())
{
delay (100);
cleardevice();
d_shearing(5,0);
d_draw();
}

---

مي دونم كه تابعم غلط كار مي كنه
لطفا راهنمايي كنيد تا اين در بسته باز بشه