VrpnAnalogServer.h

Go to the documentation of this file.

// Copyright 2015 Sensics, Inc.
//
// Licensed under the Apache License, Version 2.0 (the "License");
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at
//
//     http://www.apache.org/licenses/LICENSE-2.0
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.

#ifndef INCLUDED_VrpnAnalogServer_h_GUID_16F2A08F_2ECF_4EBB_D7B0_A2B87ACC9272
#define INCLUDED_VrpnAnalogServer_h_GUID_16F2A08F_2ECF_4EBB_D7B0_A2B87ACC9272

// Internal Includes
#include "DeviceConstructionData.h"
#include <osvr/Connection/AnalogServerInterface.h>

// Library/third-party includes
#include <vrpn_Analog.h>

// Standard includes
#include <cmath>

namespace osvr {
namespace connection {
    class VrpnAnalogServer : public vrpn_Analog, public AnalogServerInterface {
      public:
        typedef vrpn_Analog Base;
        VrpnAnalogServer(DeviceConstructionData &init)
            : Base(init.getQualifiedName().c_str(), init.conn) {
            m_setNumChannels(std::min(*init.obj.getAnalogs(),
                                      OSVR_ChannelCount(vrpn_CHANNEL_MAX)));
            // Initialize data
            memset(Base::channel, 0, sizeof(Base::channel));
            memset(Base::last, 0, sizeof(Base::last));

            // Report interface out.
            init.obj.returnAnalogInterface(*this);
        }

        static const vrpn_uint32 CLASS_OF_SERVICE = vrpn_CONNECTION_LOW_LATENCY;

        virtual bool setValue(value_type val, OSVR_ChannelCount chan,
                              util::time::TimeValue const &tv) {
            if (chan >= m_getNumChannels()) {
                return false;
            }
            Base::channel[chan] = val;
            m_reportChanges(tv);
            return true;
        }
        virtual void setValues(value_type val[], OSVR_ChannelCount chans,
                               util::time::TimeValue const &tv) {
            if (chans > m_getNumChannels()) {
                chans = m_getNumChannels();
            }
            for (OSVR_ChannelCount i = 0; i < chans; ++i) {
                Base::channel[i] = val[i];
            }
            m_reportChanges(tv);
        }

      private:
        OSVR_ChannelCount m_getNumChannels() {
            return static_cast<OSVR_ChannelCount>(Base::num_channel);
        }
        void m_setNumChannels(OSVR_ChannelCount chans) {
            Base::num_channel = chans;
        }
        void m_reportChanges(util::time::TimeValue const &tv) {
            struct timeval t;
            util::time::toStructTimeval(t, tv);
            Base::report_changes(CLASS_OF_SERVICE, t);
        }
    };

} // namespace connection
} // namespace osvr
#endif // INCLUDED_VrpnAnalogServer_h_GUID_16F2A08F_2ECF_4EBB_D7B0_A2B87ACC9272