src/isotp/receive.c

   1 #include <isotp/receive.h>
   2
   3 void isotp_handle_single_frame(IsoTpHandler* handler, IsoTpMessage* message) {
   4     isotp_complete_receive(handler, message);
   5 }
   6
   7 void isotp_complete_receive(IsoTpHandler* handler, IsoTpMessage* message) {
   8     handler->message_received_callback(message);
   9 }
  10
  11 void isotp_receive_can_frame(IsoTpHandler* handler,
  12         const uint16_t arbitration_id, const uint64_t data,
  13         const uint8_t length) {
  14     if(arbitration_id != handler->arbitration_id){
  15         return;
  16     }
  17
  18     // TODO use CanMessage struct from canutil library - allocate payload buffer
  19     // on stack, 8 bytes
  20     // TODO  this function should receive uint64_t...
  21     IsoTpProtocolControlInformation pci = (IsoTpProtocolControlInformation)
  22             getBitField(data, 0, 4, false);
  23
  24     // TODO this is messed up! need a better API for grabbing bytes
  25     uint8_t payload_length = getBitField(data, 4, 4, false);
  26     uint8_t payload[payload_length];
  27     uint64_t flipped_data = __builtin_bswap64(data);
  28     if(payload_length > 0) {
  29         memcpy(payload, &(((uint8_t*)&flipped_data)[1]), payload_length);
  30     }
  31
  32     IsoTpMessage message = {
  33         arbitration_id: arbitration_id,
  34         payload: payload,
  35         size: payload_length
  36     };
  37
  38     switch(pci) {
  39         case PCI_SINGLE:
  40             isotp_handle_single_frame(handler, &message);
  41             break;
  42         default:
  43             handler->shims->log("Only single frame messages are supported");
  44             break;
  45     }
  46 }
  47