can.hpp

Go to the documentation of this file.

 /* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *
  *  _____.___.                 .___                    .__.__      *
  *  \__  |   | ____   ____   __| _/___________    _____|__|  |     *
  *   /   |   |/ ___\ / ___\ / __ |\_  __ \__  \  /  ___/  |  |     *
  *   \____   / /_/  > /_/  > /_/ | |  | \// __ \_\___ \|  |  |__   *
  *   / ______\___  /\___  /\____ | |__|  (____  /____  >__|____/   *
  *   \/     /_____//_____/      \/            \/     \/            *
  *                          - Asgard -                             *
  * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *
  * This software can be used by students and other personal of the *
  * Bern University of Applied Sciences under the terms of the MIT  *
  * license.                                                        *
  * For other persons this software is under the terms of the GNU   *
  * General Public License version 2.                               *
  *                                                                 *
  * Copyright © 2021, Bern University of Applied Sciences.     *
  * All rights reserved.                                            *
  * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
#pragma once
 
#include <cpp/common/frontend/can.hpp>
 
#include <string>
#include <string_view>
#include <array>
 
namespace bsp::asg_coproc::drv {
 
    template<auto Context>
    struct CAN {
 
        static bool init() {
            return HAL_FDCAN_Start(Context) == HAL_OK;
        }
 
        static bool deinit() {
            return true;
        }
 
        static bool enable() {
            return HAL_CAN_Start(Context) == HAL_OK;
        }
 
        static bool disable() {
            return HAL_CAN_Stop(Context) == HAL_OK;
        }
 
 
        static void read(u32 &id, u32 &extendedId, u32 &timestamp, std::array<u8, 8> &data) {
            FDCAN_RxHeaderTypeDef rxHeader = {0};
            while (HAL_CAN_GetRxFifoFillLevel(Context, FDCAN_RX_FIFO0) == 0);
            HAL_CAN_GetRxMessage(Context, FDCAN_RX_FIFO0, &rxHeader, data.data());
            if (rxHeader.IdType == FDCAN_STANDARD_ID) {
                id = rxHeader.Identifier;
            }
            else {
                extendedId = rxHeader.Identifier;
            }
            timestamp = rxHeader.RxTimestamp;
        }
 
        template<typename T>
        static u32 write(bsp::drv::CANPacket<T> packet) {
            u32 pTxMailbox;
            FDCAN_TxHeaderTypeDef txHeader = {0};
            constexpr size_t Size = sizeof(T);
 
            std::array<u8, Size> data;
            std::memcpy(data.data(), &packet.data, Size);
            if (packet.extendedId > 0) {
                txHeader.Identifier = packet.extendedId;
                txHeader.IdType = FDCAN_EXTENDED_ID;
            }
            else {
                txHeader.Identifier = packet.id;
                txHeader.IdType = FDCAN_STANDARD_ID;
            }
 
            txHeader.DataLength = Size;
 
            HAL_CAN_AddTxMessage(Context, &txHeader, const_cast<u8*>(data.data()), &pTxMailbox);
            while (HAL_CAN_GetTxMailboxesFreeLevel(Context) != 3);
            return pTxMailbox;
        }
 
    };
 
}