TCP,机械臂测试

通过w(红色臂角度增大)s(红色臂角度减小)d(蓝色臂角度增大)a(蓝色臂角度减小)按键控制机械臂

注意:关闭计算机的杀毒软件,电脑管家,防火墙

1)基于TCP服务器的机械臂,端口号是8888, ip是Windows的ip;

查看Windows的IP:按住Windows+r 按键,输入cmd , 输入ipconfig

2)点击软件中的开启监听;

3)机械臂需要发送16进制数,共5个字节,协议如下

0xff 0x02 x y 0xff 0xff:起始结束协议,固定的;

0x02:控制机械手臂协议,固定的;

x:指定要操作的机械臂 0x00 红色摆臂 0x01 蓝色摆臂

y:指定角度

#include<stdio.h>
#include<string.h>
#include<stdlib.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <myhead.h>
#define SER_PORT 8888 //服务端口
#define SER_IP "192.168.125.82" //服务器ip地址
//#define CLI_PORT 9999// 客户端的端口
//#define CLI_IP "192.168.125.82"  //客户端的ip地址

int main(int argc, const char *argv[])
{
	//1创建用于通信的套接字文件描述符
	int cfd=-1;
	cfd=socket(AF_INET,SOCK_STREAM,0);
	if(cfd==-1)
	{
		perror("socket error");
		return -1;
	}
	printf("cfd=%d\n",cfd);
	//将端口号快速重用函数
	int reuse=1;
	if(setsockopt(cfd,SOL_SOCKET,SO_REUSEADDR,&reuse,sizeof(reuse))==-1)
	{
		perror("setsockopt error");
		return -1;
	}
	printf("端口号快速重用成功\n");
	//2绑定
/*	//2.1填充地址信息结构体
	struct sockaddr_in cin;
	cin.sin_family=AF_INET;
	cin.sin_port=htons(CLI_PORT);
	cin.sin_addr.s_addr=inet_addr(CLI_IP);
	//2.2
	if(bind(cfd,(struct sockaddr*)&cin,sizeof(cin))==-1)
	{
		perror("bind error");
		return -1;
	}
	printf("bind success\n");

	*/
	//3连接服务器
	//3.1填充服务器地址信息结构体
	struct sockaddr_in sin;
	sin.sin_family=AF_INET;
	sin.sin_port=htons(SER_PORT);
	sin.sin_addr.s_addr= inet_addr(SER_IP);
	//3.2连接 
	if(connect(cfd,(struct sockaddr*)&sin,sizeof(sin))==-1)
	{
		perror("connect error");
		return -1;
	}
	printf("connect success\n");
	//4收发数据
	char rbuf[5]={0xff,0x02,0x00,0x01,0xff}; //红色
	unsigned char bbuf[5]={0xff,0x02,0x01,0x02,0xff}; //蓝色
	send(cfd,rbuf,sizeof(rbuf),0);
	sleep(1);
	send(cfd,bbuf,sizeof(bbuf),0);


	char key=0;
	int s=1;  //控制while循环
	while(s==1)
	{
		//从终端获取按键
 

		printf("请输入相关操作:");
		scanf("%c",&key);
		getchar();
		//从输入的字节符进行分支选择
		switch(key)
		{
			case 'w':
			case 'W':
				{
					rbuf[3]+=2;
					if(rbuf[3]>=90)
					{
						rbuf[3]=90;
					}
					//发送数据
					int c=send(cfd,rbuf,sizeof(rbuf),0);
					if(c==-1)
					{
						perror("send error");
						return -1;
					}
					break;
					
				}
			case 's':
			case 'S':
				{
					rbuf[3]-=2;
					if(rbuf[3]<=-90)
					{
						rbuf[3]=-90;
					}
					//发送数据
					int c=send(cfd,rbuf,sizeof(rbuf),0);
					if(c==-1)
					{
						perror("send error");
						return -1;
					}
					break;
					
				}
			case 'd':
			case 'D':
				{
					bbuf[3]+=2;
					if(bbuf[3]>=180)
					{
						rbuf[3]=180;
					}
					//发送数据
					int c=send(cfd,bbuf,sizeof(bbuf),0);
					if(c==-1)
					{
						perror("send error");
						return -1;
					}
					break;
					
				}
			case 'a':
			case 'A':
				{
					bbuf[3]=bbuf[3]-2;
					if(bbuf[3]<=0)
					{
						bbuf[3]=0;
					}
					printf("%d\n",bbuf[3]);
					//发送数据
					int c=send(cfd,bbuf,sizeof(bbuf),0);
					if(c==-1)
					{
						perror("send error");
						return -1;
					}
					break;
					
				}
			case 'q':
			case 'Q':
				{
					s=0;
					break; //结束循环
					
				}
			default:
				{
					printf("内容输入错误请重新输入\n");
					break;
				}
						
		}
		
	}
	//5关闭套接字
	close(cfd);
	return 0;
}

相关推荐

  1. TCP机械测试

    2024-03-20 21:04:06       11 阅读
  2. baxter机械校准

    2024-03-20 21:04:06       12 阅读
  3. UR5机械控制

    2024-03-20 21:04:06       38 阅读
  4. 机械运动学逆解(牛顿法)

    2024-03-20 21:04:06       22 阅读

最近更新

  1. TCP协议是安全的吗?

    2024-03-20 21:04:06       17 阅读
  2. 阿里云服务器执行yum,一直下载docker-ce-stable失败

    2024-03-20 21:04:06       16 阅读
  3. 【Python教程】压缩PDF文件大小

    2024-03-20 21:04:06       15 阅读
  4. 通过文章id递归查询所有评论(xml)

    2024-03-20 21:04:06       18 阅读

热门阅读

  1. Android AMS——进程优先级更新(二十)

    2024-03-20 21:04:06       22 阅读
  2. FreeRTOS 简介

    2024-03-20 21:04:06       18 阅读
  3. 【Docker】常用命令 docker images

    2024-03-20 21:04:06       19 阅读
  4. 绘制虚线圆角矩形的Flutter小部件

    2024-03-20 21:04:06       19 阅读
  5. 一个好用的前端工具包 - 百涂工具

    2024-03-20 21:04:06       18 阅读
  6. git教程编写初衷

    2024-03-20 21:04:06       20 阅读
  7. Leetcode 239 滑动窗口最大值

    2024-03-20 21:04:06       20 阅读