之前写过一个太阳能自动跟踪，用到了两个转子，PD控制，设定角度自动转到对应角度，下班回去我找找代码。

可以用定时块，设置最大角和最小角就是你要的角，点下就实现了。另外再一个定时块把最大角最小角放最大，点下就恢复。
昨天刚试出来。用来做伸缩炮塔的。

public Program()
{
Runtime.UpdateFrequency = UpdateFrequency.Update1;
}
public void Save()
{
}
public static double AngleToRad(double angle)
{
return angle*180/Math.PI;
}
double last_error=0;
//设定角度
public double TurnTo(double set_rad,double get_rad)
{
const double P=0.02f;
const double D=0.5f;
double this_error=0;
double output=0;
if(set_rad>360)set_rad=360;if(set_rad<0)set_rad=0;
Echo("设定角"+set_rad);
this_error=set_rad-get_rad;
output=P*this_error+D*(this_error-last_error);
last_error=this_error;
return output;
}
public void Main(string argument, UpdateType updateSource)
{
IMyTextPanel power_lcd=GridTerminalSystem.GetBlockWithName("LCD") as IMyTextPanel;
//获取所有转子
List<IMyMotorStator>rotors=new List<IMyMotorStator>();
GridTerminalSystem.GetBlocksOfType<IMyMotorStator>(rotors);
IMyMotorStator rotor=rotors[0];
double new_angle=90;
rotor.TargetVelocityRad=(float)TurnTo(new_angle,AngleToRad(rotor.Angle));
power_lcd.ShowPublicTextOnScreen();
//输出字符
power_lcd.WritePublicText("\n\r"+AngleToRad(rotor.Angle).ToString(),true);
power_lcd.WritePublicText("\n\r"+rotor.Angle.ToString(),true);
}