Exemple #1
0
        public virtual int _loadQuaternion()
        {
            int now_stamp = 0;
            int age_ms    = 0;

            now_stamp = (int)((YAPI.GetTickCount()) & (0x7FFFFFFF));
            age_ms    = (((now_stamp - this._qt_stamp)) & (0x7FFFFFFF));
            if ((age_ms >= 10) || (this._qt_stamp == 0))
            {
                if (this.load(10) != YAPI.SUCCESS)
                {
                    return(YAPI.DEVICE_NOT_FOUND);
                }
                if (this._qt_stamp == 0)
                {
                    this._qt_w = YQt.FindQt("" + this._serial + ".qt1");
                    this._qt_x = YQt.FindQt("" + this._serial + ".qt2");
                    this._qt_y = YQt.FindQt("" + this._serial + ".qt3");
                    this._qt_z = YQt.FindQt("" + this._serial + ".qt4");
                }
                if (this._qt_w.load(9) != YAPI.SUCCESS)
                {
                    return(YAPI.DEVICE_NOT_FOUND);
                }
                if (this._qt_x.load(9) != YAPI.SUCCESS)
                {
                    return(YAPI.DEVICE_NOT_FOUND);
                }
                if (this._qt_y.load(9) != YAPI.SUCCESS)
                {
                    return(YAPI.DEVICE_NOT_FOUND);
                }
                if (this._qt_z.load(9) != YAPI.SUCCESS)
                {
                    return(YAPI.DEVICE_NOT_FOUND);
                }
                this._w        = this._qt_w.get_currentValue();
                this._x        = this._qt_x.get_currentValue();
                this._y        = this._qt_y.get_currentValue();
                this._z        = this._qt_z.get_currentValue();
                this._qt_stamp = now_stamp;
            }
            return(YAPI.SUCCESS);
        }