Revision f8cf404d components/bluetooth/checkutility.cpp

View differences:

components/bluetooth/checkutility.cpp
48 48 
{
49 49 
  if (length > 0)
50 50 
  {
51 
    chSequentialStreamWrite((BaseSequentialStream*)&SD1, (uint8_t*)message, length);
52 
//    chprintf((BaseSequentialStream*) &SD1, "[%d]\n", length);
51 
    chSequentialStreamWrite((BaseSequentialStream*)&global.sercanmux1, (uint8_t*)message, length);
52 
//    chprintf((BaseSequentialStream*) &global.sercanmux1, "[%d]\n", length);
53 53 
  }
54 54 
  return;
55 55 
}
......
72 72 
{
73 73 
  const uint16_t length = strlen(message);
74 74 
  if (length >= 1 << 10) {
75 
    chprintf((BaseSequentialStream*) &SD1, "%s(%d): ERROR: message too long!\n", __FILE__ , __LINE__);
75 
    chprintf((BaseSequentialStream*) &global.sercanmux1, "%s(%d): ERROR: message too long!\n", __FILE__ , __LINE__);
76 76 
    return;
77 77 
  }
78 78 

  		




  ......




  116
  116
  
    

  		




  117
  117
  
    
  if (msg.head.length > max_length)


  		




  118
  118
  
    
  {


  		




  119
  
  
    
    chprintf((BaseSequentialStream*) &SD1, "%s(%d): ERROR: message too long (%d of max %d bytes)!\n", __FILE__ , __LINE__, msg.head.length, max_length);


  		




  
  119
  
    
    chprintf((BaseSequentialStream*) &global.sercanmux1, "%s(%d): ERROR: message too long (%d of max %d bytes)!\n", __FILE__ , __LINE__, msg.head.length, max_length);


  		




  120
  120
  
    

  		




  121
  121
  
    
    for (uint16_t i = 0; i < msg.head.length; ++i) {


  		




  122
  122
  
    
      chSequentialStreamGet((BaseSequentialStream*)&SD3);


  		




  ......




  132
  132
  
    

  		




  133
  133
  
    
  if (uint8_t(msg.head.link_id ^ msg.n_link) != 0xFFu)


  		




  134
  134
  
    
  {


  		




  135
  
  
    
    chprintf((BaseSequentialStream*) &SD1, "%s(%d): ERROR: message link id does not match (0x%02X vs 0x%02X)!\n", __FILE__ , __LINE__, msg.head.link_id, msg.n_link);


  		




  
  135
  
    
    chprintf((BaseSequentialStream*) &global.sercanmux1, "%s(%d): ERROR: message link id does not match (0x%02X vs 0x%02X)!\n", __FILE__ , __LINE__, msg.head.link_id, msg.n_link);


  		




  136
  136
  
    
  }


  		




  137
  137
  
    

  		




  138
  138
  
    
  return msg.head.length;


  		




  ......




  160
  160
  
    
//    }


  		




  161
  161
  
    

  		




  162
  162
  
    
    if (length_buf[msg_count] == 0) {


  		




  163
  
  
    
      chprintf((BaseSequentialStream*) &SD1, "%s(%d): WARNING: receiving aborted after %d messages (%d bytes)\n", __FILE__ , __LINE__, msg_count, msg_pos);


  		




  
  163
  
    
      chprintf((BaseSequentialStream*) &global.sercanmux1, "%s(%d): WARNING: receiving aborted after %d messages (%d bytes)\n", __FILE__ , __LINE__, msg_count, msg_pos);


  		




  164
  164
  
    
      return msg_count;


  		




  165
  165
  
    
    }


  		




  166
  166
  
    

  		




  ......




  178
  178
  
    
    }


  		




  179
  179
  
    

  		




  180
  180
  
    
    if (msg_count > len_buf_size) {


  		




  181
  
  
    
      chprintf((BaseSequentialStream*) &SD1, "%s(%d): ERROR: maximum messages received (%d)!\n", __FILE__ , __LINE__, len_buf_size);


  		




  
  181
  
    
      chprintf((BaseSequentialStream*) &global.sercanmux1, "%s(%d): ERROR: maximum messages received (%d)!\n", __FILE__ , __LINE__, len_buf_size);


  		




  182
  182
  
    
      return len_buf_size;


  		




  183
  183
  
    
    }


  		




  184
  184
  
    

  		




  ......




  201
  201
  
    
  {


  		




  202
  202
  
    
    for (i = 0; i < num_bytes; ++i)


  		




  203
  203
  
    
    {


  		




  204
  
  
    
      chprintf((BaseSequentialStream*) &SD1, "%02X ", buffer[i]);


  		




  
  204
  
    
      chprintf((BaseSequentialStream*) &global.sercanmux1, "%02X ", buffer[i]);


  		




  205
  205
  
    
    }


  		




  206
  
  
    
    chprintf((BaseSequentialStream*) &SD1, "\n");


  		




  
  206
  
    
    chprintf((BaseSequentialStream*) &global.sercanmux1, "\n");


  		




  207
  207
  
    
  }


  		




  208
  208
  
    

  		




  209
  209
  
    
  return;


  		




  ......




  217
  217
  
    
  {


  		




  218
  218
  
    
    byte = chSequentialStreamGet((BaseSequentialStream*) &SD3);


  		




  219
  219
  
    
    if (print) {


  		




  220
  
  
    
      chprintf((BaseSequentialStream*) &SD1, "%c", byte);


  		




  
  220
  
    
      chprintf((BaseSequentialStream*) &global.sercanmux1, "%c", byte);


  		




  221
  221
  
    
    }


  		




  222
  222
  
    
  }


  		




  223
  223
  
    

  		




  ......




  233
  233
  
    
    byte = sdGet(&SD3);


  		




  234
  234
  
    
    //byte = chSequentialStreamGet((BaseSequentialStream*) &SD3);


  		




  235
  235
  
    
    if (print) {


  		




  236
  
  
    
      chprintf((BaseSequentialStream*) &SD1, "0x%02X <%c>\n", byte, byte);


  		




  
  236
  
    
      chprintf((BaseSequentialStream*) &global.sercanmux1, "0x%02X <%c>\n", byte, byte);


  		




  237
  237
  
    
    }


  		




  238
  238
  
    
    BaseThread::sleep(MS2ST(1));


  		




  239
  239
  
    
  }


  		












Also available in:  Unified diff