久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

標題: C_NXP_K60接收數據 代碼 [打印本頁]
作者: jackyxu    時間: 2017-4-29 09:21
標題: C_NXP_K60接收數據 代碼
C_NXP_K60接收數據 代碼

完整代碼下載：
C_NXP_K60接收數據.rar (1.63 MB, 下載次數: 10)




  1. #include "gpio.h"
  2. #include "common.h"
  3. #include "uart.h"
  4. #include "mcg.h"
  5. #include "packet.h"

  7. #include <string.h>
  8. #include <stdio.h>

  10. static Packet_t pktB; /* used for data anaysis */
  11. bool DataReceived = false;

  13. uint8_t ID;
  14. int16_t AccRaw[3];
  15. int16_t GyoRaw[3];
  16. int16_t MagRaw[3];
  17. float Eular[3];
  18. int32_t Pressure;

  20. void UART4_RX_TX_IRQHandler(void)
  21. {
  22.     uint8_t ch;
  23.     UART_Type *UARTx = (UART_Type*)UART4;

  25.     if(UARTx->S1 & UART_S1_RDRF_MASK)
  26.     {
  27.         ch = (uint8_t)UARTx->D;
  28.         Packet_Decode(ch);
  29.     }
  30.    
  31.     if(UARTx->S1 & UART_S1_OR_MASK)
  32.     {
  33.         ch = (uint8_t)UARTx->D;
  34.         UARTx->S1 |= UART_S1_OR_MASK;
  35.     }
  36. }


  39. void OnDataReceived(Packet_t *pkt)
  40. {
  41.     memcpy(&pktB, pkt, sizeof(Packet_t));
  42.     DataReceived = true;
  43. }


  46. int main(void)
  47. {
  48.     DelayInit();
  49.     DelayMs(10);
  50.    
  51.     /* 使用 D6 D7輸出結果 */
  52.     UART_Init(UART0_RX_PD06_TX_PD07, 115200);
  53.     printf("IMU receive demo\r\n");
  54.    
  55.     /* 使用E24 E25接收IMU數據 */
  56.     UART_Init(UART4_RX_PE25_TX_PE24, 115200);

  58.     Packet_t pktA; /* used for data receive */
  59.     Packet_DecodeInit(&pktA, OnDataReceived);
  60.    
  61.     /* open interrupt */
  62.     UART_SetIntMode(HW_UART4, kUART_IntRx, true);
  63.    
  64.     while(1)
  65.     {
  66.         if(DataReceived == true)
  67.         {
  68.             /* 按出廠默認輸出協議接收
  69.             輸出
  70.             0x5A+0xA5+LEN_LOW+LEN_HIGH+CRC_LOW+CRC+HIGH+ 0x90+ID(1字節) + 0xA0+Acc(加速度6字節) + 0xB0+Gyo(角速度6字節) + 0xC0+Mag(地磁6字節) + 0xD0 +AtdE(歐拉角6字節) + 0xF0+Pressure(壓力4字節)
  71.             */
  72.             if(pktB.buf[0] == kItemID) /* user ID */
  73.             {
  74.                 ID = pktB.buf[1];
  75.             }
  76.             
  77.             if(pktB.buf[2] == kItemAccRaw)  /* Acc raw value */
  78.             {
  79.                 memcpy(AccRaw, &pktB.buf[3], 6);
  80.             }
  81.             
  82.             if(pktB.buf[9] == kItemGyoRaw)  /* gyro raw value */
  83.             {
  84.                 memcpy(GyoRaw, &pktB.buf[10], 6);
  85.             }
  86.             
  87.             if(pktB.buf[16] == kItemMagRaw)  /* mag raw value */
  88.             {
  89.                 memcpy(MagRaw, &pktB.buf[17], 6);
  90.             }
  91.             
  92.             if(pktB.buf[23] == kItemAtdE)  /* atd E */
  93.             {
  94.                 Eular[0] = ((float)(int16_t)(pktB.buf[24] + (pktB.buf[25]<<8)))/100;
  95.                 Eular[1] = ((float)(int16_t)(pktB.buf[26] + (pktB.buf[27]<<8)))/100;
  96.                 Eular[2] = ((float)(int16_t)(pktB.buf[28] + (pktB.buf[29]<<8)))/10;
  97.             }
  98.             
  99.             if(pktB.buf[30] == kItemPressure)
  100.             {
  101.                 memcpy(&Pressure, &pktB.buf[31], 4);
  102.             }
  103.             
  104. //             printf("AccRaw: %d %d %d\r\n", AccRaw[0], AccRaw[1], AccRaw[2]);
  105. //             printf("GyoRaw: %d %d %d\r\n", GyoRaw[0], GyoRaw[1], GyoRaw[2]);
  106. //             printf("MagRaw: %d %d %d\r\n", MagRaw[0], MagRaw[1], MagRaw[2]);
  107.                printf("Angle:    %0.2f %0.2f %0.2f\r\n", Eular[0], Eular[1], Eular[2]);
  108. //             printf("Pressure: %d Pa\r\n", Pressure);
  109.              DataReceived = false;
  110.          }
  111.     }
  112. }

  114. void HardFault_Handler(void)
  115. {
  116.     printf("HardFault_Handler\r\n");
  117.     while(1);
  118. }
復制代碼






歡迎光臨 (http://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 精品美女久久久久久免费 | 国产区视频在线观看 | 国产无套一区二区三区久久 | 在线免费激情视频 | 久草网址 | 午夜一级黄色片 | 天天干天天玩天天操 | 午夜网| 狼色网| 成人精品国产一区二区4080 | 久久免费精品 | 亚洲夜夜爽 | 欧美 日韩 国产 在线 | 欧美a√ | 日韩免费高清视频 | 自拍偷拍第一页 | 亚洲伊人久久综合 | 午夜男人的天堂 | 中文字幕久久精品 | 精品久久久久久久久久久久久久 | 日韩激情在线 | 久久久精选 | 国产乱码精品一品二品 | 国产精品入口麻豆www | 久久久久久综合 | 草草视频在线观看 | 日本精a在线观看 | 久久国产一区二区三区 | 欧美久久综合 | 国产精品精品视频一区二区三区 | 精品人伦一区二区三区蜜桃网站 | 伊人网站 | 精品久久国产 | 金莲网 | 久久久国产精品视频 | 国产精品久久国产精品久久 | 色橹橹欧美在线观看视频高清 | 涩涩导航| 91精品国产高清一区二区三区 | 91久久国产精品 | 欧美高清视频一区 |