using System;
using Microsoft.SPOT;

using Microsoft.VisualStudio.TestTools.UnitTesting;
using CPF;

using System.Text;
using System.Threading;
using HWModules;
using SWModules;

namespace CPFUnitTests
{
    [TestClass]
    public class GPSUnitTests
    {
        [TestMethod]
        public void TestGPS()
        {
            HWModules.MotherBoard motherboard = MotherBoard.Instance;
            motherboard.EnableChannelPower(MotherBoard.ChannelNames.GPSChannel);
            
            GPS1 gps = GPS1.Instance;
            gpsUBlox.GPSPosition currentGPSPosition = new gpsUBlox.GPSPosition();
            gpsUBlox.SVStatus currentSVStatus = new gpsUBlox.SVStatus();

            BTConsole btConsole = BTConsole.Instance;
            btConsole.powerUp();
            btConsole.init();
            
            StringBuilder sbTemp = new StringBuilder(128);
            for (int i = 0; i < 100; i++)
            {
                sbTemp.Clear();
                sbTemp.Append("Sending GPS getPosition");
                Debug.Print(sbTemp.ToString());
                btConsole.SendLine(sbTemp);

                currentGPSPosition = gps.getPUBX00Position();
                sbTemp.Clear();
                sbTemp.Append("Position raw message: ");
                sbTemp.Append(currentGPSPosition.rawMessage.ToString());
                Debug.Print(sbTemp.ToString());
                btConsole.SendLine(sbTemp);

                Thread.Sleep(2000);

                sbTemp.Clear();
                sbTemp.Append("Sending GPS PUBX,03 Get Sat Status");
                Debug.Print(sbTemp.ToString());
                btConsole.SendLine(sbTemp);

                currentSVStatus = gps.getSatStatus();
                sbTemp.Clear();
                sbTemp.Append("SV Status: ");
                sbTemp.Append(currentSVStatus.rawMessage.ToString());
                Debug.Print(sbTemp.ToString());
                btConsole.SendLine(sbTemp);

                Thread.Sleep(5000);
            }
        }
    }
}