p38192567
/
followme_e-tron
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Auto pilot system.Be careful of the speed!

This commit is contained in:
Valk Richard Li 2019-08-09 21:55:24 +08:00 committed by GitHub
parent 42e900a18d
commit 58985f8d99
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
1 changed files with 80 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

80
Nasal/auto_crash.nas Normal file
View File

@ -0,0 +1,80 @@
# Road check and auto pilot(??) by ValKmjolnir
var position_change = func(position_val,value){
if(position_val+value>180)
position_val += value-360;
else if(position_val+value<-180)
position_val += value+360;
else
position_val += value;
return position_val;
}
var road_check_func = func(){
var lat = getprop("/position/latitude-deg");
var lon = getprop("/position/longitude-deg");
var position_info = geodinfo(lat,lon);
var now_friction_factor = position_info[1].friction_factor;
# the friction_factor of freeway runway and road is 1
if(now_friction_factor==1){
var car_heading = 0;
var lat_change = 0;
var lon_change = 0;
var left_range = 0;
var right_range = 0;
for(var i=0;i>-0.00005;i-=0.000001)
{
car_heading=getprop("/orientation/heading-deg");
lat_change=math.sin(math.pi*car_heading/180);
lon_change=-math.cos(math.pi*car_heading/180);
lat=getprop("/position/latitude-deg")+0.0001*math.cos(math.pi*car_heading/180);
lon=getprop("/position/longitude-deg")+0.0001*math.sin(math.pi*car_heading/180);
var other_position_info=geodinfo(position_change(lat,i*lat_change),position_change(lon,i*lon_change));
var other_friction_factor=other_position_info[1].friction_factor;
if(other_friction_factor==1)
right_range+=1;
else
break;
}
for(var i=0;i<0.00005;i+=0.000001)
{
car_heading=getprop("/orientation/heading-deg");
lat_change=math.sin(math.pi*car_heading/180);
lon_change=-math.cos(math.pi*car_heading/180);
lat=getprop("/position/latitude-deg")+0.0001*math.cos(math.pi*car_heading/180);
lon=getprop("/position/longitude-deg")+0.0001*math.sin(math.pi*car_heading/180);
var other_position_info=geodinfo(position_change(lat,i*lat_change),position_change(lon,i*lon_change));
var other_friction_factor=other_position_info[1].friction_factor;
if(other_friction_factor==1)
left_range+=1;
else
break;
}
if(left_range>right_range)
{
setprop("/controls/flight/rudder",-0.05);
#print("right ",right_range);
}
else if(left_range<right_range)
{
setprop("/controls/flight/rudder",0.05);
#print("left ",left_range);
}
else
setprop("/controls/flight/rudder",0);
}
};
var road_check_timer = maketimer(0.1,road_check_func);
var toggle_auto_pilot = func(){
if(!road_check_timer.isRunning)
{
road_check_timer.start();
setprop("/sim/messages/copilot", "zi dong sheng tian see tong yeee tse yung. Auto Sheng Tian System Activated!");
}
else
{
road_check_timer.stop();
setprop("/sim/messages/copilot", "ze dong sheng teaan see tong yee guan bee. Auto Sheng Teaan System is off.");
}
}