low-can-binding/utils/socketcan-j1939/socketcan-j1939-data.cpp

   1 /*
   2  * Copyright (C) 2018, 2019 "IoT.bzh"
   3  * Author "Arthur Guyader" <arthur.guyader@iot.bzh>
   4  *
   5  * Licensed under the Apache License, Version 2.0 (the "License");
   6  * you may not use this file except in compliance with the License.
   7  * You may obtain a copy of the License at
   8  *
   9  *       http://www.apache.org/licenses/LICENSE-2.0
  10  *
  11  * Unless required by applicable law or agreed to in writing, software
  12  * distributed under the License is distributed on an "AS IS" BASIS,
  13  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  14  * See the License for the specific language governing permissions and
  15  * limitations under the License.
  16  */
  17
  18
  19 #include "socketcan-j1939-data.hpp"
  20 #include "socketcan-j1939-addressclaiming.hpp"
  21 #include "../../binding/application.hpp"
  22
  23 namespace utils
  24 {
  25     /**
  26      * @brief Open a socket for receive or send data
  27      *
  28      * @param device_name The device name to open the socket
  29      * @param pgn The pgn to receive only him
  30      * @return int Return the number of the socket
  31      */
  32     int socketcan_j1939_data_t::open(std::string device_name, pgn_t pgn)
  33     {
  34         int ret = socketcan_j1939_t::open(device_name,htole64(J1939_NAME_ECU),pgn,J1939_NO_ADDR);
  35         if(ret >= 0)
  36         {
  37             if(tx_address_.can_addr.j1939.pgn != J1939_NO_PGN)
  38             {
  39                 add_filter(J1939_NO_NAME,tx_address_.can_addr.j1939.pgn,J1939_NO_ADDR,J1939_NO_NAME,J1939_NO_PGN,J1939_NO_ADDR);
  40             }
  41             define_opt();
  42         }
  43         return ret;
  44     }
  45
  46     /**
  47      * @brief Write a message but check if the address claiming is operation before
  48      *
  49      * @param obj A j1939 message
  50      * @return int 0 if the write is ok
  51      */
  52     int socketcan_j1939_data_t::write_message(message_t& obj)
  53     {
  54         std::unique_lock<std::mutex> lock(mutex_claiming_);
  55         application_t &application = application_t::instance();
  56         socketcan_j1939_addressclaiming_t *socket_addr_claimed = static_cast<socketcan_j1939_addressclaiming_t*>(application.get_socket_address_claiming().get());
  57         while(socket_addr_claimed->get_state() != claiming_state::OPERATIONAL)
  58         {
  59             socketcan_j1939_t::signal_address_claiming_.wait(lock);
  60             if(socket_addr_claimed->get_state() == claiming_state::INVALID)
  61             {
  62                 AFB_ERROR("Invalid state");
  63                 return -1;
  64             }
  65         }
  66         return socketcan_j1939_t::write_message(obj);
  67     }
  68 }