最新代码
This commit is contained in:
@ -263,7 +263,7 @@ static BLE_send_data_t sensor_send_buffer[SENSOR_DATA_BUFFER_SIZE]; // 存放ble
|
||||
*/
|
||||
void sensor_read_data(){
|
||||
|
||||
xlog("=======sensor_read_data START\n");
|
||||
// xlog("=======sensor_read_data START\n");
|
||||
static signed short combined_raw_data[6];
|
||||
static int initialized = 0;
|
||||
static int calibration_done = 0;
|
||||
@ -275,7 +275,7 @@ void sensor_read_data(){
|
||||
|
||||
static sensor_data_t tmp;
|
||||
SL_SC7U22_RawData_Read(tmp.acc_data,tmp.gyr_data);
|
||||
xlog("=======sensor_read_data middle 1\n");
|
||||
// xlog("=======sensor_read_data middle 1\n");
|
||||
memcpy(&combined_raw_data[0], tmp.acc_data, 3 * sizeof(signed short));
|
||||
memcpy(&combined_raw_data[3], tmp.gyr_data, 3 * sizeof(signed short));
|
||||
|
||||
@ -292,7 +292,7 @@ void sensor_read_data(){
|
||||
memcpy(tmp.gyr_data, &combined_raw_data[3], 3 * sizeof(signed short));
|
||||
circle_buffer_write(&sensor_read, &tmp);
|
||||
}
|
||||
xlog("=======sensor_read_data END\n");
|
||||
// xlog("=======sensor_read_data END\n");
|
||||
|
||||
}
|
||||
|
||||
@ -318,6 +318,7 @@ void calculate_data(){
|
||||
}
|
||||
|
||||
static int count = 0;
|
||||
extern char xt_Check_Flag;
|
||||
void BLE_send_data(){
|
||||
if(circle_buffer_is_empty(&sensor_send)){
|
||||
// xlog("sensor_send_buffer: send buffer empty\n");
|
||||
@ -328,14 +329,22 @@ void BLE_send_data(){
|
||||
circle_buffer_read(&sensor_send, &tmp);
|
||||
|
||||
if(count >=50){
|
||||
|
||||
int num_chars_written;
|
||||
count = 0;
|
||||
char* division = "==========\n";
|
||||
send_data_to_ble_client(division,strlen(division));
|
||||
|
||||
char log_buffer[100]; // 100个字符应该足够了
|
||||
|
||||
|
||||
// extern char iic_read_len;
|
||||
// extern char iic_write_result;
|
||||
// num_chars_written = snprintf(log_buffer, sizeof(log_buffer),"SL_SC7U22_Check=0x%d, %d, %d\n", xt_Check_Flag, iic_read_len, iic_write_result);
|
||||
// send_data_to_ble_client(&log_buffer,strlen(log_buffer));
|
||||
|
||||
memset(&log_buffer, 0, 100);
|
||||
// 使用 snprintf 进行格式化
|
||||
int num_chars_written = snprintf(
|
||||
num_chars_written = snprintf(
|
||||
log_buffer, // 目标缓冲区
|
||||
sizeof(log_buffer), // 目标缓冲区的最大容量
|
||||
"s %d, %dcm/s, %dcm\n", // 格式化字符串
|
||||
@ -393,8 +402,8 @@ void BLE_send_data(){
|
||||
}
|
||||
|
||||
//iic测试调用的
|
||||
#if 1
|
||||
extern char xt_Check_Flag = 10;
|
||||
#if 0
|
||||
|
||||
static u16 xt_iic_test_id;
|
||||
char log_buffer_1[100];
|
||||
extern char sen_log_buffer_1[100];
|
||||
@ -441,6 +450,21 @@ void xt_iic_test(){
|
||||
|
||||
// SL_SC7U22_Config();
|
||||
}
|
||||
|
||||
#endif
|
||||
|
||||
#if 0
|
||||
u16 xt_iic_test_id;
|
||||
char hw_iic_init_result;
|
||||
void xt_hw_iic_test(){
|
||||
char log_buffer[100];
|
||||
extern char iic_read_len;
|
||||
extern char iic_write_result;
|
||||
|
||||
int num_chars_written = snprintf(log_buffer, sizeof(log_buffer),"init result:%d, SL_SC7U22_Check=0x%d,%d,%d\n",hw_iic_init_result, xt_Check_Flag, iic_read_len, iic_write_result);
|
||||
extern void send_data_to_ble_client(const u8* data, u16 length);
|
||||
send_data_to_ble_client(&log_buffer,strlen(log_buffer));
|
||||
}
|
||||
#endif
|
||||
|
||||
void xtell_task_create(void){
|
||||
@ -484,7 +508,6 @@ void xtell_task_create(void){
|
||||
// SkiingTracker_Init(&skiing_data);
|
||||
xlog("SkiingTracker_Init\n");
|
||||
|
||||
// create_process(&test_id, "test",NULL, test, (int)(DELTA_TIME*1000));
|
||||
|
||||
create_process(&sensor_read_data_id, "read",NULL, sensor_read_data, 10);
|
||||
|
||||
@ -492,7 +515,9 @@ void xtell_task_create(void){
|
||||
|
||||
create_process(&ble_send_data_id, "send",NULL, BLE_send_data, 1);
|
||||
|
||||
// create_process(&xt_iic_test_id,"iic_test",NULL,xt_iic_test,1000);
|
||||
|
||||
#if 0
|
||||
hw_iic_init_result = ret;
|
||||
create_process(&xt_iic_test_id,"iic_test",NULL,xt_hw_iic_test,1000);
|
||||
#endif
|
||||
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user