03-27-2017, 06:38 PM
Code:
extern void object::Main()
{
move(5);
smove(5);
}
void object::smove(int dist)
{
point b = chkpos(dist), pos = this.position;
//while(distance2d(b, this.position)>1) //Y U NO WORK
while(true)
{
point c = chkpos(20);
if(topo(c)>this.position.z){motor(0.1,0.1); adjalt(7,8);}
else{motor(1,1);adjalt(4,5);}
}
}
void object::adjalt(int min, int max)
{
int alt = this.altitude;
if(alt<min){while(alt<min){jet(1);alt = this.altitude;}}
if(alt>max){while(alt>max){jet(-0.65);alt = this.altitude;}}
if(alt<1 && alt<min){while(alt>min){motor(0.2, 0.2); jet(1);alt = this.altitude;}}
jet(0);
}
point object::chkpos(int c) //winny bledow przy przelotach w okolicy wysokich struktur
{
int a, b, ori = this.orientation;
point t = this.position, p;
if(0 <= ori && ori <= 90){ori = 90 - ori; a = c*cos(ori); b = c*sin(ori); p.x=(t.x+a); p.y=(t.y+b);} //I
if(90 <= ori && ori <= 180){ori = 180 - ori;a = c*cos(ori); b = c*sin(ori); p.x=(t.x-a); p.y=(t.y+b);} // II
if(180 <= ori && ori <= 270){ori = 270 - ori;a = c*cos(ori); b = c*sin(ori); p.x=(t.x-a); p.y=(t.y-b);} //III
if(270 <= ori && ori <= 360){ori = 360 - ori;a = c*cos(ori); b = c*sin(ori); p.x=(t.x+a); p.y=(t.y-b);} //IV
p.z = topo(p);
return p;
}
It won't go for set distance, and sometimes it climbs obstacles properly, sometimes don't. Don't know why.