Tsetse Kerbin takeoff

set steeringmanager:rollcontrolanglerange to 180.
set proprad to 5.8.
set rotormods to ship:modulesnamed("ModuleRoboticServoRotor").
set rotors to list().
for rm in rotormods {
    local rotor to lexicon().
    set rotor["part"] to rm:part.
    set rotor["mod"] to rm.

    set rotor["blades"] to list().
    for bm in rm:part:ModulesNamed("ModuleControlSurface") {
        local b to bm:part.

        local blade to lexicon().
        set blade["mod"] to bm.
        set blade["offset"] to vdot(-b:Facing:starvector, b:position - b:parent:position).
        set blade["proprad"] to proprad.

	    bm:setfield("deploy", true).

        rotor["blades"]:add(blade).
    }

    rotors:add(rotor).
    rm:setfield("torque limit(%)", 100).
}

set first to true.
set taraoa to 4.5.
set deploycopy to 9.
fuelcells on.
set displayIndex to 0.

//Lock Vars
set rpmtarget to min(459,max(0, throttle * 460)).

//Functions

//Control Loop
on round(time:seconds * 10) {
	set rpmtarget to min(459,max(0, throttle * 460)).
    set rpmcopy to rpmtarget.
    for rotor in rotors {
        rotor:mod:setfield("rpm limit", rpmcopy ).
        set calcAirspeed to (2 * constant:pi * (rotor:blades[0]:proprad + rotor:blades[0]:offset) * rpmcopy /60).
        set deploycopy to max(3, taraoa + arctan2(airspeed, calcAirspeed)).
        for blade in rotor:blades {
            blade:mod:setfield("deploy angle", deploycopy).
        }
     }

    return first.
}


set x to 90.
lock p to 0.
lock steering to heading(x,p).
lock throttle to 1.
when airspeed > 140 then set p to 7.