StreetLight/Assets/CalibrationRecorderBehavior.cs

using Assets.StreetLight.Scripts;
using System;
using System.Collections;
using System.Collections.Concurrent;
using System.Collections.Generic;
using System.IO;
using System.Linq;
using System.Threading.Tasks;
using UnityEngine;

namespace Assets
{
    public class CalibrationRecorderBehavior : MonoBehaviour
    {
        PersonManager PersonManager => personManagerLazy.Value;
        Lazy<PersonManager> personManagerLazy;

        private void Awake()
        {
            personManagerLazy = new Lazy<PersonManager>(FindObjectOfType<PersonManager>);
        }

        BlockingCollection<Action> taskQueue;

        string fileName = @$"C:\Users\nick.steyer\Desktop\{DateTime.Now:yyyy-dd-M_HH-mm-ss}.csv";

        void Start()
        {
            taskQueue = new BlockingCollection<Action>();
            if (!File.Exists(fileName))
            {
                File.WriteAllLines(fileName, new string[] { "Time,WorldX,WorldY,WorldZ,UnityX,UnityY,UnityZ" });
            }
        }

        // Update is called once per frame
        void Update()
        {
            var persons = PersonManager.Persons;

            if (PersonManager.Persons.Count == 1)
            {
                var person = PersonManager.Persons.Single();
                var marker = GameObject.Find("CalibrationMarker");

                var personPosition = person.WorldPosition;
                var markerPosition = marker.transform.position;

                taskQueue.Add(() => File.AppendAllLines(fileName, new string[] { FormattableString.Invariant($"{DateTime.Now:yyyy-MM-dd-HH-mm-ss-ff},{personPosition.x},{personPosition.y},{personPosition.z},{markerPosition.x},{markerPosition.y},{markerPosition.z}") }));
                Task.Run(() => taskQueue.Take().Invoke());
            }
        }
    }
}