uavcan.h

Go to the documentation of this file.

/*
 * Copyright (C) 2021 Freek van Tienen <freek.v.tienen@gmail.com>
 *
 * This file is part of paparazzi.
 *
 * paparazzi 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 2, or (at your option)
 * any later version.
 *
 * paparazzi 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 paparazzi; see the file COPYING.  If not, write to
 * the Free Software Foundation, 59 Temple Place - Suite 330,
 * Boston, MA 02111-1307, USA.
 */
#ifndef MODULES_UAVCAN_ARCH_H
#define MODULES_UAVCAN_ARCH_H
 
#include <canard.h>
#include <string.h>
#include "mcu_periph/can.h"
#include "modules/core/threads.h"
#include "utils/circular_buffer.h"
 
 
#ifndef UAVCAN_TX_FIFO_SIZE
#define UAVCAN_TX_FIFO_SIZE 1024
#endif
 
#ifndef UAVCAN_MSG_MAX_SIZE
#define UAVCAN_MSG_MAX_SIZE 256
#endif
 
 
struct uavcan_iface_t {
  struct pprzaddr_can can_net;
  uint32_t can_baudrate;
 
  event_source_t tx_request;
 
  pprz_mutex_t mutex;
  pprz_thread_t thread_tx;
  // void *thread_tx_wa;
  // void *thread_uavcan_wa;
  // size_t thread_tx_wa_size;
  // size_t thread_uavcan_wa_size;
  pprz_bsem_t bsem;
 
  uint8_t node_id;
  CanardInstance canard;
  uint8_t canard_memory_pool[1024 * 2];
 
  uint8_t _tx_fifo_buffer[UAVCAN_TX_FIFO_SIZE];
  struct circular_buffer _tx_fifo;
  pprz_mutex_t tx_fifo_mutex;
 
  uint8_t transfer_id;
  bool initialized;
};
 
typedef void (*uavcan_callback)(struct uavcan_iface_t *iface, CanardRxTransfer *transfer);
 
struct uavcan_event_t {
  uint16_t data_type_id;
  uint64_t data_type_signature;
  uavcan_callback cb;
  struct uavcan_event_t *next;
};
typedef struct uavcan_event_t uavcan_event;
 
#if UAVCAN_USE_CAN1
extern struct uavcan_iface_t uavcan1;
#endif
#if UAVCAN_USE_CAN2
extern struct uavcan_iface_t uavcan2;
#endif
 
void uavcan_init(void);
void uavcan_bind(uint16_t data_type_id, uint64_t data_type_signature, uavcan_event *ev, uavcan_callback cb);
void uavcan_broadcast(struct uavcan_iface_t *iface, uint64_t data_type_signature, uint16_t data_type_id,
                      uint8_t priority, const void *payload, uint16_t payload_len);
 
#endif /* MODULES_UAVCAN_ARCH_H */