AP_HAL_VRBRAIN: added some new modules for I2C wrapper

libraries/AP_HAL_VRBRAIN/I2CDevice.cpp

@@ -0,0 +1,78 @@
+/// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
+/*
+ * This file is free software: you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * This file is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
+ * See the GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program.  If not, see <http://www.gnu.org/licenses/>.
+ */
+#include "I2CDevice.h"
+
+#include <AP_HAL/AP_HAL.h>
+
+#include "Util.h"
+
+namespace VRBRAIN {
+
+uint8_t VRBRAIN::VRBRAIN_I2C::instance;
+
+/*
+  implement wrapper for VRBRAIN I2C driver
+ */
+bool VRBRAIN_I2C::do_transfer(uint8_t address, const uint8_t *send, uint32_t send_len, uint8_t *recv, uint32_t recv_len)
+{
+    if (!init_done) {
+        init_done = true;
+        // we do late init() so we can setup the device paths
+        snprintf(devname, sizeof(devname), "AP_I2C_%u", instance);
+        snprintf(devpath, sizeof(devpath), "/dev/api2c%u", instance);
+        init_ok = (init() == OK);
+        if (init_ok) {
+            instance++;
+        }
+    }
+    if (!init_ok) {
+        return false;
+    }
+    set_address(address);
+    bool ret = (transfer(send, send_len, recv, recv_len) == OK);
+    return ret;
+}
+    
+I2CDevice::I2CDevice(uint8_t bus, uint8_t address) :
+    _bus(bus),
+    _address(address)
+{
+}
+    
+I2CDevice::~I2CDevice()
+{
+}
+
+bool I2CDevice::transfer(const uint8_t *send, uint32_t send_len,
+                         uint8_t *recv, uint32_t recv_len)
+{
+    return _bus.do_transfer(_address, send, send_len, recv, recv_len);
+}
+
+bool I2CDevice::read_registers_multiple(uint8_t first_reg, uint8_t *recv,
+                                        uint32_t recv_len, uint8_t times)
+{
+    return false;
+}
+
+AP_HAL::OwnPtr<AP_HAL::I2CDevice>
+I2CDeviceManager::get_device(uint8_t bus, uint8_t address)
+{
+    auto dev = AP_HAL::OwnPtr<AP_HAL::I2CDevice>(new I2CDevice(bus, address));
+    return dev;
+}
+
+}

libraries/AP_HAL_VRBRAIN/I2CDevice.h

@@ -0,0 +1,97 @@
+/// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
+/*
+ * Copyright (C) 2015-2016  Intel Corporation. All rights reserved.
+ *
+ * This file is free software: you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * This file is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
+ * See the GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program.  If not, see <http://www.gnu.org/licenses/>.
+ */
+#pragma once
+
+#include <inttypes.h>
+
+#include <AP_HAL/HAL.h>
+#include <AP_HAL/I2CDevice.h>
+#include <AP_HAL/utility/OwnPtr.h>
+#include <AP_HAL_Empty/AP_HAL_Empty.h>
+#include <AP_HAL_Empty/AP_HAL_Empty_Private.h>
+#include "I2CWrapper.h"
+
+namespace VRBRAIN {
+
+class I2CDevice : public AP_HAL::I2CDevice {
+public:
+    static I2CDevice *from(AP_HAL::I2CDevice *dev)
+    {
+        return static_cast<I2CDevice*>(dev);
+    }
+
+    I2CDevice(uint8_t bus, uint8_t address);
+    ~I2CDevice();
+
+    /* See AP_HAL::I2CDevice::set_address() */
+    void set_address(uint8_t address) override { _address = address; }
+
+    /* See AP_HAL::I2CDevice::set_retries() */
+    void set_retries(uint8_t retries) override { _retries = retries; }
+
+    /* See AP_HAL::Device::set_speed(): Empty implementation, not supported. */
+    bool set_speed(enum Device::Speed speed) override { return true; }
+
+    /* See AP_HAL::Device::transfer() */
+    bool transfer(const uint8_t *send, uint32_t send_len,
+                  uint8_t *recv, uint32_t recv_len) override;
+
+    bool read_registers_multiple(uint8_t first_reg, uint8_t *recv,
+                                 uint32_t recv_len, uint8_t times) override;
+
+    /* See AP_HAL::Device::register_periodic_callback() */
+    AP_HAL::Device::PeriodicHandle register_periodic_callback(
+        uint32_t period_usec, AP_HAL::Device::PeriodicCb) override
+    {
+        /* Not implemented yet */
+        return nullptr;
+    }
+
+    /* See AP_HAL::Device::adjust_periodic_callback() */
+    bool adjust_periodic_callback(AP_HAL::Device::PeriodicHandle h, uint32_t period_usec) override
+    {
+        /* Not implemented yet */
+        return false;
+    }
+
+    // this makes no sense on VRBRAIN
+    int get_fd() override { return -1; }
+
+    AP_HAL::Semaphore* get_semaphore() override { return &semaphore; }
+
+private:
+    // we use an empty semaphore as the underlying I2C class already has a semaphore
+    Empty::Semaphore semaphore;
+    VRBRAIN_I2C _bus;
+    uint8_t _address;
+    uint8_t _retries = 0;
+};
+
+class I2CDeviceManager : public AP_HAL::I2CDeviceManager {
+public:
+    friend class I2CDevice;
+
+    static I2CDeviceManager *from(AP_HAL::I2CDeviceManager *i2c_mgr)
+    {
+        return static_cast<I2CDeviceManager*>(i2c_mgr);
+    }
+
+    AP_HAL::OwnPtr<AP_HAL::I2CDevice> get_device(uint8_t bus, uint8_t address) override;
+};
+
+}

libraries/AP_HAL_VRBRAIN/I2CWrapper.h

@@ -0,0 +1,28 @@
+#include <AP_HAL/AP_HAL.h>
+
+#if CONFIG_HAL_BOARD == HAL_BOARD_VRBRAIN
+
+#include <arch/board/board.h>
+#include "board_config.h"
+#include <drivers/device/i2c.h>
+#include "AP_HAL_VRBRAIN.h"
+
+extern const AP_HAL::HAL& hal;
+/*
+  wrapper class for I2C to expose protected functions from PX4Firmware
+ */
+class VRBRAIN::VRBRAIN_I2C : public device::I2C {
+public:
+    VRBRAIN_I2C(uint8_t bus) : I2C(devname, devpath, bus, 0, 400000UL) { }
+    bool do_transfer(uint8_t address, const uint8_t *send, uint32_t send_len, uint8_t *recv, uint32_t recv_len);
+
+private:
+    static uint8_t instance;
+    bool init_done;
+    bool init_ok;
+    char devname[10];
+    char devpath[14];
+};
+
+
+#endif // CONFIG_HAL_BOARD