Exemplo n.º 1
0
    // Use this for initialization
    void Start()
    {
        MCCDAQwrap.flashLED();
        MCCDAQwrap.writeVolts(1, 0.0f);  // Set all voltages to zero
        //Using Random Class
        rndGen = new System.Random();

        xPos   = 0.0f;
        deltaX = 0.0f;

        Counter    = 0;
        daqInput   = 0.0f;
        pertSignal = 0.0f;

        // ******************************* Scene ***********************************
        SceneName = SceneManager.GetActiveScene().name;

        // *******************************    EXPERIMENTS SETUP   *****************************

        bool bVRgui = false;

        if (bVRgui)
        {
            //Load the GUI and wait until its finished
            ProcessStartInfo startInfo = new ProcessStartInfo();
            startInfo.WorkingDirectory = "VR_GUI";
            startInfo.FileName         = "VR_GUI.exe";
            Process.Start(startInfo).WaitForExit();

            StreamReader csv_file = new StreamReader(@"VR_GUI\\ExpParams.csv");
            string       legends  = csv_file.ReadLine();
            string       Params   = csv_file.ReadLine();
            csv_file.Close();
            string[] ParamsList = Params.Split(',');

            flagExpNum  = (int)float.Parse(ParamsList[0]); // 0: Normal VR  1: Randomized Half Sinusoidal  2:PRTS    3:TrapZ    4:TrapV   5: Sum of Sins   6: PRBS
            P2P_Amp     = float.Parse(ParamsList[1]);      //deg
            Vel_max     = float.Parse(ParamsList[2]);      //dps
            minDeltaSec = float.Parse(ParamsList[3]);      //Wait Time this is minDelta. delta = minDelta + rand(0, minDelta)
            minWSec     = float.Parse(ParamsList[4]);      //Pulse Width, this is w. W = w + rand(0, w)
            NumPulses   = (int)float.Parse(ParamsList[5]); // or Periods

            Time_0  = float.Parse(ParamsList[6]);          //Start perturbations after this time seconds
            T_total = float.Parse(ParamsList[7]);

            PRTS_dt = float.Parse(ParamsList[8]); //sec

            TrapV_ta = float.Parse(ParamsList[9]);
            TrapV_tv = float.Parse(ParamsList[10]);
            TrapV_tx = float.Parse(ParamsList[11]);

            SOS_minFreq      = float.Parse(ParamsList[12]);
            SOS_maxFreq      = float.Parse(ParamsList[13]);
            SOS_freqCount    = (int)float.Parse(ParamsList[14]);
            Random_Direction = (int)float.Parse(ParamsList[15]);
            dtVR             = Time.fixedDeltaTime; //Time resolution (time per frame) measured for VR device with FixedUpdate() method
        }
        else
        {
            flagExpNum = 4;                    // 0: Normal VR  1: Randomized Half Sinusoidal  2:PRTS    3:TrapZ    4:TrapV   5: Sum of Sins   6: PRBS

            Time_0      = 4.0f;                //Start perturbations after this time seconds
            dtVR        = Time.fixedDeltaTime; //Time resolution (time per frame) measured for VR device with FixedUpdate() method
            P2P_Amp     = 0.14f;               //meter
            Vel_max     = 0.14f;               // m/s
            minDeltaSec = 2.5f;                //Wait Time this is minDelta. delta = minDelta + rand(0, minDelta)
            minWSec     = 2.5f;                //Pulse Width, this is w. W = w + rand(0, w)
            NumPulses   = 10;                  // or Periods

            PRTS_dt = 0.1f;                    //sec

            TrapV_ta = 0.4f;
            TrapV_tv = 0.6f;
            TrapV_tx = 2.5f;

            SOS_minFreq   = 0.05f;
            SOS_maxFreq   = 1.5f;
            SOS_freqCount = 15;
        }

        switch (flagExpNum)
        {
        case 0:     // No purturbation
        {
            logFileName = "Normal";
            PosArray    = new float[(int)Math.Round(T_total / dtVR)];
            Array.Clear(PosArray, 0, PosArray.Length);
            T_total = 200.0f;        //sec
            break;
        }

        case 1:     // *******************  1: Randomized half Sinusoids *********************
        {
            logFileName         = "RandHalfSin";
            RS_RotationVelocity = Mathf.PI / 2;                         // A.Sin(wt) w = Rad per second;  default = pi / 2
            frequency           = RS_RotationVelocity / (2 * Mathf.PI); //v = w/2pi   Hz
            PosArray            = InputFunctions.HalfSin_offline(NumPulses, P2P_Amp, RS_RotationVelocity, minDeltaSec, SceneName, out T_total, dtVR).ToArray();
            P2P_Amp_calc        = P2P_Amp;
            break;
        }

        case 2:     // ***************************  2: PRTS  ********************************
        {
            logFileName  = "PRTS";
            PRTS_dt      = 0.2f;    //sec
            Vel_max      = P2P_Amp / (17.0f * PRTS_dt);
            T_total      = 242 * PRTS_dt * NumPulses;
            PosArray     = InputFunctions.PRTS_offline(NumPulses, PRTS_dt, Vel_max, SceneName, out T_total, dtVR).ToArray();
            P2P_Amp_calc = P2P_Amp;
            Debug.Log(logFileName + " PRTS_dt = " + PRTS_dt + " Seconds");
            break;
        }

        case 3:     // ***************************  2: TrapZ  ********************************
        {
            logFileName  = "TrapZ";
            PosArray     = InputFunctions.TrapZ_offline(NumPulses, P2P_Amp, Vel_max, minDeltaSec, minWSec, SceneName, out T_total, dtVR).ToArray();
            P2P_Amp_calc = P2P_Amp;;
            break;
        }

        case 4:     // *************************   4: TrapV   ********************************
        {
            logFileName  = "TrapV";
            PosArray     = InputFunctions.TrapV_offline(NumPulses, minDeltaSec, TrapV_ta, TrapV_tv, TrapV_tx, Vel_max, SceneName, out T_total, dtVR).ToArray();
            P2P_Amp_calc = Vel_max * (TrapV_ta + TrapV_tv);
            Debug.Log(" TrapV Times: ta = " + TrapV_ta + " t_v = " + TrapV_tv + " t_x = " + TrapV_tx);
            break;
        }

        case 5:     // *************************  5: SumOfSin  *******************************
        {
            logFileName   = "SumOfSin";
            SOS_minFreq   = 0.05f;
            SOS_maxFreq   = 0.15f;
            SOS_freqCount = 1;
            PosArray      = InputFunctions.SumOfSin_offline(NumPulses, P2P_Amp, SOS_minFreq, SOS_maxFreq, SOS_freqCount, SceneName, out T_total, dtVR).ToArray();
            P2P_Amp_calc  = P2P_Amp;;
            break;
        }

        case 6:     // *************************  5: PRBS  *******************************
        {
            logFileName  = "PRBS";
            T_total      = 10.0f;    //seconds
            PosArray     = InputFunctions.PRBS_offline(P2P_Amp, 0.5f, T_total, SceneName, dtVR).ToArray();
            P2P_Amp_calc = P2P_Amp;;
            break;
        }
        }

        Time_F  = Time_0 + T_total;
        Pos_max = PosArray.Max();
        Pos_min = PosArray.Min();

        Debug.Log(logFileName + " P2P_Amp_calc = " + P2P_Amp_calc + " meters");
        Debug.Log(logFileName + " Vel_max = " + Vel_max + " mps");
        Debug.Log(logFileName + " Time Total = " + T_total + " seconds");


        // *******************   Write to file   *******************
        dt         = DateTime.Now;
        dateString = dt.ToString("dd-MM-yyyy");
        timeString = dt.ToString("HH-mm");
        string logDir     = "log/Online/" + dateString + "/" + SceneName + "/" + logFileName;
        string currentDir = Directory.GetCurrentDirectory();
        string logPath    = Path.Combine(currentDir, logDir);

        Directory.CreateDirectory(logPath);
        dataLogger    = new StreamWriter(logPath + "/VR_" + logFileName + '_' + timeString + ".txt");
        timeLog       = new StreamWriter(logPath + "/Time_" + logFileName + '_' + timeString + ".txt");
        daqSignal     = new StreamWriter(logPath + "/daq_" + logFileName + '_' + timeString + ".txt");
        headMotionLog = new StreamWriter(logPath + "/HeadMotion_" + logFileName + '_' + timeString + ".txt");
    }