Chinaunix首页 | 论坛 | 博客
  • 博客访问: 311612
  • 博文数量: 27
  • 博客积分: 758
  • 博客等级: 军士长
  • 技术积分: 369
  • 用 户 组: 普通用户
  • 注册时间: 2010-04-08 23:10
文章分类

全部博文(27)

文章存档

2014年(1)

2012年(26)

我的朋友

分类: C/C++

2012-04-24 10:40:57

通过串口读数据的代码。串口连接了Arduino + MPU6050传感器模块,返回来的数据是逗号分割的加速度和角速度值。


  1. #include <stdio.h> /* Standard input/output definitions */
  2. #include <string.h> /* String function definitions */
  3. #include <unistd.h> /* UNIX standard function definitions */
  4. #include <fcntl.h> /* File control definitions */
  5. #include <errno.h> /* Error number definitions */
  6. #include <termios.h> /* POSIX terminal control definitions */

  7. /*
  8.  * @brief Open serial port with the given device name
  9.  *
  10.  * @return The file descriptor on success or -1 on error.
  11.  */
  12. int open_port(char *port_device)
  13. {
  14.     int fd; /* File descriptor for the port */

  15.     fd = open(port_device, O_RDWR | O_NOCTTY | O_NDELAY);
  16.     if (fd == -1)
  17.     {
  18.         perror("open_port: Unable to open /dev/ttyS0 - ");
  19.     }
  20.     else
  21.         fcntl(fd, F_SETFL, 0);

  22.     return (fd);
  23. }

  24. int main()
  25. {
  26.     struct termios options;

  27.     int fd=open_port("/dev/ttyACM0");
  28.     if(fd==-1){
  29.         return -1;
  30.     }

  31.     tcgetattr(fd, &options);


  32.     //Set the baud rates to 38400...
  33.     cfsetispeed(&options, B38400);
  34.     cfsetospeed(&options, B38400);


  35.     //Enable the receiver and set local mode...
  36.     options.c_cflag |= (CLOCAL | CREAD);
  37.     options.c_cflag &= ~CSIZE; /* Mask the character size bits */
  38.     options.c_cflag |= CS8; /* Select 8 data bits */

  39.     //No parity
  40.     options.c_cflag &= ~PARENB;
  41.     options.c_cflag &= ~CSTOPB;
  42.     options.c_cflag &= ~CSIZE;
  43.     options.c_cflag |= CS8;


  44.     //Set the new options for the port...
  45.     tcsetattr(fd, TCSANOW, &options);

  46.     int ax,ay,az,gx,gy,gz;
  47.     char buf[1024];
  48.     char* pos=buf;

  49.     while(1){
  50.         ssize_t n=read(fd, pos, 1);
  51.         if(n==1){
  52.             if(*pos=='\n' ){
  53.                 *(pos+1)=0;
  54.                 sscanf(buf,"%d,%d,%d,%d,%d,%d", &ax, &ay, &az, &gx, &gy, &gz);
  55.                 printf("acc/gyro: %d %d %d %d %d %d\n", ax, ay, az, gx, gy, gz);
  56.                 pos=buf;
  57.             }else{
  58.                 pos++;
  59.             }
  60.         }
  61.     }


  62.     close(fd);
  63. }

阅读(7329) | 评论(2) | 转发(1) |
0

上一篇:没有了

下一篇:MYSQL的一些技巧

给主人留下些什么吧!~~

桔色花朵2012-04-25 16:22:51

顶一个,不错的博客啊。。。

1471893852012-04-25 16:15:03

linux下面怎样读取从rfid读卡器串口发过来的数据?