技术分享：基于RW007 高速 WIFI 模块 BLE透传mpu6050数据

#define SAMPLE_UART_NAME       "uart6"    /* 串口设备名称 */

static rt_device_t serial;                /* 串口设备句柄 */

char str[] = "hello RT-Thread!\r\n";

struct serial_configure config = RT_SERIAL_CONFIG_DEFAULT; /* 配置参数 */

/* 查找串口设备 */

serial = rt_device_find(SAMPLE_UART_NAME);

​

/* 以中断接收及轮询发送模式打开串口设备 */

rt_device_open(serial, RT_DEVICE_FLAG_INT_RX);

/* 发送字符串 */

rt_device_write(serial, 0, str, (sizeof(str) - 1));

/* 查找系统中的串口设备 */

    serial = rt_device_find(BLE_UART_NAME);

    if (!serial)

     {

           rt_kprintf("find %s failed!\n", BLE_UART_NAME);

           return RT_ERROR;

     }

     rt_kprintf("open uart6 ok...\n");

     rt_device_open(serial, RT_DEVICE_FLAG_INT_RX)；

void mpu6050_thread_entry(void *parameter)

{

    rt_int16_t temp;        //温度

    rt_int16_t gx,gy,gz;    //三轴加速度

    rt_int16_t ax,ay,az;    //三轴角速度

​

    char TempStr[15] = {0};

    //char Gx[10] = {0};

​

    rt_err_t ret;

​

    while(1)

    {

        ret = mpu6050_temperature_get(&temp);

        if (ret != RT_EOK)

        {

            rt_kprintf("mpu6050 : get temperature error\r\n");

        }

        ret = mpu6050_accelerometer_get(&ax, &ay, &az);

        if (ret != RT_EOK)

        {

            rt_kprintf("mpu6050 : get acc error\r\n");

        }

        ret = mpu6050_gyroscope_get(&gx, &gy, &gz);

        if (ret != RT_EOK)

        {

            rt_kprintf("mpu6050 : get gyro error\r\n");

        }

        if (ret == RT_EOK)

        {

            //rt_kprintf("mpu6050: temperature=%-6d gx=%-6d gy=%-6d gz=%-6d ax=%-6d ay=%-6d az=%-6d\r\n",temp/100,gx,gy,gz,ax,ay,az);

            sprintf(TempStr,"55temp=%dAA",temp/100);

            rt_device_write(serial, 0, TempStr, (sizeof(TempStr) - 1));

            memset(TempStr,0,sizeof(TempStr)/sizeof(char));

            rt_thread_delay(rt_tick_from_millisecond(500));

            sprintf(TempStr,"55gx=%dAA",gx);

            rt_device_write(serial, 0, TempStr, (sizeof(TempStr) - 1));

            memset(TempStr,0,sizeof(TempStr)/sizeof(char));

            rt_thread_delay(rt_tick_from_millisecond(500));

​

            sprintf(TempStr,"55gy=%dAA",gy);

            rt_device_write(serial, 0, TempStr, (sizeof(TempStr) - 1));

            memset(TempStr,0,sizeof(TempStr)/sizeof(char));

            rt_thread_delay(rt_tick_from_millisecond(500));

​

            sprintf(TempStr,"55gz=%dAA",gz);

            rt_device_write(serial, 0, TempStr, (sizeof(TempStr) - 1));

            memset(TempStr,0,sizeof(TempStr)/sizeof(char));

            rt_thread_delay(rt_tick_from_millisecond(500));

​

            sprintf(TempStr,"55ax=%dAA",ax);

            rt_device_write(serial, 0, TempStr, (sizeof(TempStr) - 1));

            memset(TempStr,0,sizeof(TempStr)/sizeof(char));

            rt_thread_delay(rt_tick_from_millisecond(500));

​

            sprintf(TempStr,"55ay=%dAA",ay);

            rt_device_write(serial, 0, TempStr, (sizeof(TempStr) - 1));

            memset(TempStr,0,sizeof(TempStr)/sizeof(char));

            rt_thread_delay(rt_tick_from_millisecond(500));

​

            sprintf(TempStr,"55az=%dAA",az);

            rt_device_write(serial, 0, TempStr, (sizeof(TempStr) - 1));

            memset(TempStr,0,sizeof(TempStr)/sizeof(char));

        }

        rt_thread_delay(rt_tick_from_millisecond(1000));

    }

}

static int ble_example_init(void)

{

    rt_kprintf("ble_example_init\n");

    rt_uint8_t roles = 0;

    roles = RW007_BLE_INIT_ROLE_CENTRAL;

​

    rw007_ble_init(roles);

​

    rw007_ble_resp_handle_cb_reg(rw007_ble_resp_handle);

    rw007_ble_ntf_handle_cb_reg(rw007_ble_ntf_handle);

    return 0;

​

}

static int ble_example_connect(void)

{

    rt_kprintf("ble_example_connect\n");

    ble_addr_t addr;

    addr.type = RW007_BLE_ADDR_PUBLIC;

    rt_kprintf("str_addr: %s\n", "ee:dd:ff:ee:cc:aa");

​

    _hexstrtoaddr("ee:dd:ff:ee:cc:aa", addr.val);

​

    rt_kprintf("mac addr: %2x:%2x:%2x:%2x:%2x:%2x\n", addr.val[0], addr.val[1],

                                                          addr.val[2], addr.val[3],

                                                          addr.val[4], addr.val[5]);

    rw007_ble_connect(&addr);

    return 0;

}

static int ble_example_gatt_notify_change_by_uuid(void)

{

    rt_kprintf("ble_example_gatt_notify_change_by_uuid\n");

    rt_uint16_t conn_handle = 0;

    rt_uint16_t char_value = 0;

​

    int uuidint;

    ble_uuid_any_t uuid;

​

    conn_handle = 1;

    char_value = 1;

​

    uuid.u16.u.type = BLE_UUID_TYPE_16;

    sscanf("0xfff1", "%x", &uuidint);

    uuid.u16.value = uuidint & 0xFFFFu;

​

    rw007_ble_gatt_notify_change_by_uuid(conn_handle, &uuid, char_value);

    return 0;

}

case RW007_BLE_NTF_TYPE_NOTIFY_RX:

        {    rt_kprintf("RW007_BLE_NTF_TYPE_NOTIFY_RX\n");

            int offset = 0, notify_data_len = 0;

            char *pcBegin = NULL;

            char *pcEnd = NULL;

            char cRes[15]={0};

            struct ble_gap_event *event = RT_NULL;

            void *notify_data = RT_NULL;

​

            event = (struct ble_gap_event *)data;

            offset = sizeof(struct ble_gap_event);

            notify_data = data + offset;

            notify_data_len = size - offset;

​

            //hex_dump(notify_data, notify_data_len);

            

            pcBegin = strstr(notify_data,"55");

            pcEnd = strstr(notify_data,"AA");

            if(pcBegin == NULL || pcEnd == NULL || pcBegin > pcEnd)

            {

              rt_kprintf("data not found!!!\n");

            }

            else {

                pcBegin += strlen("55");

                rt_memcpy(cRes, pcBegin, pcEnd-pcBegin);

                rt_kprintf("data:%s\n",cRes);

            }

​

            break;

        }

static int ble_example_start(void)

{

    ble_example_init();

    rt_thread_delay(1000);

    ble_example_connect();

    rt_thread_delay(5000);

    ble_example_gatt_notify_change_by_uuid();

​

    return 0;

​

}

MSH_CMD_EXPORT(ble_example_start,ble_example_start)