controller: Prepare project ot use the Controller

[apps/agl-service-can-low-level.git] / low-can-binding / can / can-encoder.cpp

diff --git a/low-can-binding/can/can-encoder.cpp b/low-can-binding/can/can-encoder.cpp
index 44b5d9b..fb68b87 100644 (file)
--- a/low-can-binding/can/can-encoder.cpp
+++ b/low-can-binding/can/can-encoder.cpp
@@ -37,10 +37,10 @@ void encoder_t::encode_data(std::shared_ptr<signal_t> sig, std::vector<uint8_t>
        uint32_t bit_position = sig->get_bit_position();
        int new_start_byte = 0;
        int new_end_byte = 0;
-       int new_start_bit_tmp = 0;
-       int new_end_bit = 0;
+       uint8_t new_start_bit = 0;
+       uint8_t new_end_bit = 0;
 
-       converter_t::signal_to_bits_bytes(bit_position, bit_size, new_start_byte, new_end_byte, new_start_bit_tmp, new_end_bit);
+       converter_t::signal_to_bits_bytes(bit_position, bit_size, new_start_byte, new_end_byte, new_start_bit, new_end_bit);
 
        int len_signal_bytes_tmp = new_end_byte - new_start_byte + 1;
 
@@ -53,17 +53,12 @@ void encoder_t::encode_data(std::shared_ptr<signal_t> sig, std::vector<uint8_t>
        {
                len_signal_bytes = (uint8_t) len_signal_bytes_tmp;
        }
-
-       uint8_t new_start_bit = 0;
-       if(new_start_bit_tmp > 255)
+/*
+       if(new_start_bit > 255)
        {
                AFB_ERROR("Error signal %s too long",sig->get_name().c_str());
        }
-       else
-       {
-               new_start_bit = (uint8_t) new_start_bit_tmp;
-       }
-
+*/
        uint8_t new_bit_size = 0;
        if(bit_size > 255)
        {
@@ -93,7 +88,7 @@ void encoder_t::encode_data(std::shared_ptr<signal_t> sig, std::vector<uint8_t>
                int j=0;
                for(int i=0;i<new_bit_size;i++)
                {
-                       int mask = 1 << ((i%8)+new_start_bit);
+                       int mask = 0x80 >> ((i%8)+new_start_bit);
 
                        uint8_t mask_v = 0;
                        if(mask > 255)
@@ -174,20 +169,37 @@ message_t* encoder_t::build_message(const std::shared_ptr<signal_t>& signal, uin
        std::vector<uint8_t> data;
        if(signal->get_message()->is_fd())
        {
-               message = new can_message_t(CANFD_MAX_DLEN,signal->get_message()->get_id(),CANFD_MAX_DLEN,signal->get_message()->get_format(),false,CAN_FD_FRAME,data,0);
+               message = new can_message_t( CANFD_MAX_DLEN,
+                                                                        signal->get_message()->get_id(),
+                                                                        CANFD_MAX_DLEN,
+                                                                        false,
+                                                                        signal->get_message()->get_flags(),
+                                                                        data,
+                                                                        0);
 
                return build_frame(signal,value,message, factor, offset);
        }
 #ifdef USE_FEATURE_J1939
        else if(signal->get_message()->is_j1939())
        {
-               message = new j1939_message_t(J1939_MAX_DLEN,signal->get_message()->get_length(),signal->get_message()->get_format(),data,0,J1939_NO_NAME,signal->get_message()->get_id(),J1939_NO_ADDR);
+               message = new j1939_message_t( signal->get_message()->get_length(),
+                                                                          data,
+                                                                          0,
+                                                                          J1939_NO_NAME,
+                                                                          signal->get_message()->get_id(),
+                                                                          J1939_NO_ADDR);
                return build_frame(signal,value,message, factor, offset);
        }
 #endif
        else
        {
-               message = new can_message_t(CAN_MAX_DLEN,signal->get_message()->get_id(),CAN_MAX_DLEN,signal->get_message()->get_format(),false,0,data,0);
+               message = new can_message_t(CAN_MAX_DLEN,
+                                                                       signal->get_message()->get_id(),
+                                                                       CAN_MAX_DLEN,
+                                                                       false,
+                                                                       signal->get_message()->get_flags(),
+                                                                       data,
+                                                                       0);
                return build_frame(signal,value,message, factor, offset);
        }
 }