#define DEBUG_MODE_FULL
#include "script_component.hpp"

FUNC(guidance_LGB_LOAL_PFH) = {
    //TRACE_1("enter", _this);
    _args = _this select 0;
    //PARAMS_7(_shooter,_weapon,_muzzle,_mode,_ammo,_magazine,_projectile);
    _lgb = _args select 6;
    _curVelocity = velocity _lgb;
    
    if(!alive _lgb) exitWith {
        [(_this select 1)] call cba_fnc_removePerFrameHandler;
    };
    
    _targets = [_lgb, ACE_DEFAULT_LASER_CODE, 70, _curVelocity] call uo_laser_fnc_findLaserDesignator;
    //TRACE_2("Targets", _target, _targets);
    
    if((_targets select 0)) then {
        _target = _targets select 1;
        
        // player sideChat "FUCK!";
        // drop ["\a3\data_f\Cl_basic","","Billboard",1,20,(getPos _lgb),[0,0,0],1,1.275,1.0,0.0,[5],[[1,0,0,1]],[0],0.0,2.0,"","",""];
        
        
        _yVec = vectorDir _lgb;
        _zVec = vectorUp _lgb;
        _xVec = vectorNormalized (_yVec vectorCrossProduct _zVec);
        
        _lgbPos = getPosASL _lgb;
        // player sideChat "G!";
        _targetPos = getPosASL _target;
        if((count _targetPos) > 0) then {
            // player sideChat format["f: %1", _targetPos];
            _addHeight = [0,0,(_lgbPos distance _targetPos)*0.06];
            // drawLine3D [(ASLtoATL _targetPos) vectorAdd _addHeight, ASLtoATL _targetPos, [0,1,0,1]];
            _targetPos = _targetPos vectorAdd _addHeight;
            
            
            
            _def = 0.0025;
            
            _targetVectorSeeker = [_lgb, [_xVec, _yVec, _zVec], _targetPos] call FUNC(translateToWeaponSpace);
            // _targetVectorSeeker = _lgb worldToModel (ASLtoATL _targetPos);
            // _targetVectorSeeker = [0,0,0] vectorFromTo _targetVectorSeeker;
            _yaw = 0.0;
            if((_targetVectorSeeker select 0) < 0) then {
                _yaw = -_def;
            } else {
                if((_targetVectorSeeker select 0) > 0) then {
                    _yaw = _def;
                };
            };
            
            _pitch = 0.0;
            if((_targetVectorSeeker select 2) < 0) then {
                _pitch = -_def;
            } else {
                if((_targetVectorSeeker select 2) > 0) then {
                    _pitch = _def;
                };
            };
    #ifdef DEBUG_MODE_FULL
            drawIcon3D ["\a3\ui_f\data\IGUI\Cfg\Cursors\selectover_ca.paa", [1,1,1,1], ASLtoATL _lgbPos, 0.75, 0.75, 0, str _vectorTo, 1, 0.025, "TahomaB"];
            drawLine3D [ASLtoATL _lgbPos, ASLtoATL _targetPos, [1,0,0,1]];
            
            _distance = ([getPos startPos, _lgbPos] call BIS_fnc_distance2D);
            _marker = createMarkerLocal [format["m%1", MARKERCOUNT], [_distance, _lgbPos select 2]];
            _marker setMarkerTypeLocal "mil_dot";
            _marker setMarkerColorLocal "ColorRed";

            MARKERCOUNT = MARKERCOUNT + 1;
    #endif        
    
            if(accTime > 0) then {
                _outVector = [_lgb, [_xVec, _yVec, _zVec], [_yaw, 1/accTime, _pitch]] call FUNC(translateToModelSpace);
                // _outVector = _lgb modelToWorldVisual [_yaw, 1, _pitch];
                // _outVector = ATLtoASL _outVector;
                _vectorTo = _lgbPos vectorFromTo _outVector;
                
                // hintSilent format["v: %1", _vectorTo];
            
                // _lgb setVectorDir _vectorTo;
                _lgb setVectorDirAndUp [_vectorTo, vectorUp _lgb];
            };
            
    #ifdef DEBUG_MODE_FULL
            hintSilent format["d: %1", _lgbPos vectorDistance _targetPos];
    #endif
        };
    };
};

FUNC(guidance_LGB_LOAL) = {
    PARAMS_7(_shooter,_weapon,_muzzle,_mode,_ammo,_magazine,_projectile);
    
    [FUNC(guidance_LGB_LOAL_PFH), 0, _this] call cba_fnc_addPerFrameHandler;
};

PARAMS_7(_shooter,_weapon,_muzzle,_mode,_ammo,_magazine,_projectile);
_fireMode = _shooter getVariable ["ACE_FIRE_SELECTION", ACE_DEFAULT_FIRE_SELECTION];

switch (_fireMode select 0) do {
    // Default to FIREMODE_DIRECT_LOAL
    // FIREMODE_DIRECT_LOAL
    default {
        LOG("Initiating FIREMODE_DIRECT_LOAL");
        _this call FUNC(guidance_LGB_LOAL);
    };
};