Subversion Repositories group.electronics

using MCP2221;
using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using System.Timers;
using WindowsInput;
using WindowsInput.Native;

namespace nitdcscore{    
    class NITAHFSDevice  {
        
        DcsBios _bios;
        Bridge_mcp2221 _mcp;

        InputSimulator sendkey = new InputSimulator();

        private readonly uint pot_threshold = 5;
        private readonly Object _lockObject = new object();
        private Boolean dev_init = false;

        uint _prev_inputs = 0;
        public uint inputs { get; set; }

        ushort _prev_adc { get; set; }
        public ushort adc { get; set; }

        public NITAHFSDevice(ref DcsBios bios, Bridge_mcp2221 mcp) {
            _bios = bios;
            _mcp = mcp;

        }

        public void refresh(object sender, ElapsedEventArgs e) {
            this.GetInputs();

            if (_prev_inputs != inputs) {
                Console.WriteLine("AHFS Input: " + (inputs).ToString("X"));

                // Train - Safe - Arm
                Switch3Pos(8, 9, "AHCP_MASTER_ARM");

                // Gunarm - Safe - Arm
                Switch3Pos(10, 11, "AHCP_GUNPAC");

                // Train - Safe - Arm
                Switch3Pos(12, 13, "AHCP_LASER_ARM");
                
                // Off - On
                Switch2Pos(14, "AHCP_TGP");

                // Radar  - Delta - Baro
                Switch3Pos(0, 1, "AHCP_ALT_SCE");

                // Night - Day
                Switch2Pos(2, "AHCP_HUD_DAYNIGHT");

                //Stby - Norm
                Switch2Pos(15, "AHCP_HUD_MODE");

                // Off - On
                Switch2Pos(3, "AHCP_CICU");

                // Off - On
                Switch2Pos(4, "AHCP_JTRS");

                //Off - Test - On
                Switch3Pos(6, 5, "AHCP_IFFCC");

                //
                Switch2Pos(7, "HARS_FAST_ERECT");

                // Fuel System

                // 
                Switch2Pos(16, "FSCP_AMPL");
                // 
                Switch2Pos(24, "FSCP_BOOST_MAIN_L");
                // 
                Switch2Pos(25, "FSCP_BOOST_MAIN_R");
                // 
                Switch2Pos(26, "FSCP_BOOST_WING_L");
                // 
                Switch2Pos(27, "FSCP_BOOST_WING_R");
                // 
                Switch2Pos(28, "FSCP_CROSSFEED");
                // 
                Switch2Pos(30, "FSCP_EXT_TANKS_FUS");
                // 
                Switch2Pos(31, "FSCP_EXT_TANKS_WING");
                // 
                Switch2Pos(20, "FSCP_FD_MAIN_L", true);
                // 
                Switch2Pos(21, "FSCP_FD_MAIN_R", true);
                // 
                Switch2Pos(18, "FSCP_FD_WING_L", true);
                // 
                Switch2Pos(19, "FSCP_FD_WING_R", true);
                // 
                Switch2Pos(17, "FSCP_LINE_CHECK");
                // 
                Switch2Pos(23, "FSCP_RCVR_LEVER"); // Technically a 3pos, but 3rd not needed
                // 
                Switch2Pos(29, "FSCP_TK_GATE");


                _prev_inputs = inputs;
            }

            // Do the Refueling light adc
            ushort lowerval = 0;
            if (_prev_adc >= 5)
                lowerval = (ushort)(_prev_adc - pot_threshold);

            ushort upperval = 1023;
            if (_prev_adc <= 1018)
                upperval = (ushort)(_prev_adc + pot_threshold);

            if ((adc <= lowerval) || (adc >= upperval)) {
                _prev_adc = adc;
                //Console.WriteLine("ADC Input: " + (adc).ToString());
                ushort refuellight = map_ushort(adc, 0, 930, 0, 0xffff);
                _bios.SendData("ALCP_RCVR_LTS " + refuellight.ToString() + "\n");
            }
        }

        public uint Switch2Pos(int pin, String cmd, Boolean invert = false) {
            uint chg = (uint)(this._prev_inputs >> pin) & 0x01;
            uint norm = (uint)(this.inputs >> pin) & 0x01;
            uint value = 0;

            if ((uint)(norm) == 1) {
                value = (uint)(invert ? 0 : 1);
            }

            if (norm != chg) {
                _bios.SendData(cmd + " " + value.ToString() + "\n");
                Console.WriteLine(cmd + ":" + value.ToString());
            }
            return value;
        }

        public uint Switch3Pos(int pin0, int pin1, String cmd, Boolean invert = false) {
            uint value = 1;
            uint chg0 = (uint)(this._prev_inputs >> pin0) & 0x01;
            uint chg1 = (uint)(this._prev_inputs >> pin1) & 0x01;
            uint nrm0 = (uint)(this.inputs >> pin0) & 0x01;
            uint nrm1 = (uint)(this.inputs >> pin1) & 0x01;

            if ((uint)nrm0 == 1)
                value = (uint)(invert ? 2 : 0);
            else if ((uint)nrm1 == 1)
                value = (uint)(invert ? 0 : 2);

            if ((nrm0 != chg0) || (nrm1 != chg1)) {
                _bios.SendData(cmd + " " + value.ToString() + "\n");
                Console.WriteLine(cmd + ":" + value.ToString());
            }

            return value;
        }

        public ushort map_ushort(ushort x, ushort in_min, ushort in_max, ushort out_min, ushort out_max) {
            return (ushort)((x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min);
        }

        public int init() {
            // Select our CDU power module
            int rslt = _mcp.SelectDevice("AHCP/FSCP Panel");
            if (rslt != 0) {
                return rslt;
            }

            // Get the initial ADC value
            this._prev_adc = this.adc = _mcp.ReadADC(1);
            

            // Enable the mcp23017
            _mcp.WriteGpio(3, 1);

            // Set io dir, pullups and rev polarity
            byte[] data;
            // Soldered a couple of inputs wrong, the f0 is to reverse them (fuel boost switches)
            data = new byte[] { 0x00, 0xff, 0xff, 0xf0, 0xff }; // All inputs & polarity
            _mcp.WriteI2cData(0x40, data, 5);
            data = new byte[] { 0x0c, 0xff, 0xff }; // All pullups = on
            _mcp.WriteI2cData(0x40, data, 3);

            data = new byte[] { 0x00, 0xff, 0xff, 0xff, 0xff }; // All inputs & polarity
            _mcp.WriteI2cData(0x42, data, 5);
            data = new byte[] { 0x0c, 0xff, 0xff }; // All pullups = on
            _mcp.WriteI2cData(0x42, data, 3);

            this.GetInputs();
            this._prev_inputs = this.inputs;

            this.dev_init = true;
            return 0;
        }

        public void Enable() {
            if (!this.dev_init)
                this.init();

        }
        public void Disable() {

        }

        public void GetInputs() {         
            
            lock (_lockObject) {
                this.adc = _mcp.ReadADC(1);
            }

            byte[] data;
            data = new byte[] { 0x12 }; // Select GPIOA register
            _mcp.WriteI2cData(0x40, data, 1);

            data = new byte[] { 0x00, 0x00 }; // Read two bytes
            int rslt = _mcp.ReadI2CData(0x41, ref data, 2);
            
            this.inputs = (uint)data[0] << 24;
            this.inputs |= (uint)data[1] << 16;

            data = new byte[] { 0x12 }; // Select GPIOA register
            _mcp.WriteI2cData(0x42, data, 1);

            data = new byte[] { 0x00, 0x00 }; // Read two bytes
            rslt = _mcp.ReadI2CData(0x43, ref data, 2);

            this.inputs += (uint)data[0] << 8;
            this.inputs |= (uint)data[1];


        }
    }
}