zju1005 bfs

一开始结构体开太小了。。。死都过不去。。。。后来改成100000的竟然AC了。。。太TM坑爹了。。。


#include <iostream>
#include <stack>
#include <cstdio>
#define size 100000
using namespace std;

stack <int > newStack;
int C[2] ,goal;
int tail;
int AC;
int s;	

struct bullet
{
	int S[2];
    int last;
	int oper;
}BUT[size];



void init_BUT(int w)
{
		for( ; w >0;w--)
		{
		  BUT[w].last = BUT[w].oper =	BUT[w].S[0]=BUT[w].S[1] = 0;
		}

}


void printf_BUT(int w)
{
   int n = w;
   while ( w != 0)
   {
	   newStack.push(BUT[w].oper);
	   w=BUT[w].last;
   }
   while (!newStack.empty())
   {
	   if(newStack.top() == 1){printf("fill A\n");	newStack.pop();continue;}
	   if (newStack.top() == 2){printf("fill B\n");newStack.pop();continue;}
	   if (newStack.top() == 3){printf("pour A B\n");newStack.pop();continue;}
	   if (newStack.top() == 4){printf("pour B A\n");newStack.pop();continue;}
       if (newStack.top() == 5){printf("empty A\n");newStack.pop();continue;}
       if (newStack.top() == 6){printf("empty B\n");newStack.pop();continue;}
       

   }

   printf("success\n");
   init_BUT(n);
}


void fill(int x,int w,int i)
{
	BUT[w].S[x] = C[x];
	BUT[w].S[1-x] = BUT[i  ].S[1-x];
	BUT[w].last = i  ;
    if(!x) BUT[w].oper = 1;//满前一个
	else BUT[w].oper = 2;//满后一个


	if(BUT[w].S[0] == goal || BUT[w].S[1] == goal) AC = 1;
    
	if(AC)printf_BUT(w);

}

void pour(int a,int b,int i,int w)
{
	BUT[w].S[b] = BUT[i  ].S[a] + BUT[i ].S[b];
	if(BUT[w].S[b] > C[b]) { BUT[w].S[a] =  BUT[w].S[b] - C[b];BUT[w].S[b] = C[b];}
	else BUT[w].S[a] = 0;
	BUT[w].last = i ;
	
	if(a>b)BUT[w].oper = 4;//a倒进b
	else BUT[w].oper =3;//b倒进a

	if(BUT[w].S[0] == goal || BUT[w].S[1] == goal) AC = 1;

	if(AC)printf_BUT(w);

}

void emptyBUT(int  a, int i ,int w)
{
	BUT[w].last = i  ;
	BUT[w].S[a] = 0;
	BUT[w].S[1 - a] = BUT[i ].S[1-a];

	if(!a)BUT[w].oper = 5;
	else BUT[w].oper = 6;

   if(BUT[w].S[0] == goal || BUT[w].S[1] == goal) AC = 1;

	if(AC)printf_BUT(w);


}


void BFS(int i)
{
	
	

	i++;
	//*******先测可否满A******
	
	if(AC)return;
	if( BUT[i].S[0] < C[0]) fill(0,s++,i);

	//*******测可否满B*******

	if(AC)return;
	if( BUT[i].S[1] < C[1]) fill(1,s++,i);

	//*******可否A到进B******

	if(AC)return;
	if(BUT[i].S[0] && BUT[i].S[1] <C[1]  ) pour(0,1,i,s++);

	//*******可否B倒进A*****

	if(AC)return;
	if(BUT[i].S[1] && BUT[i].S[0] < C[0] )pour(1,0,i,s++);

	//*******可否空A****

	if(AC) return;
	if(BUT[i].S[0] && BUT[i].S[1])emptyBUT(0 , i,s++);

    //*******可否空B****
	if(AC) return;
	if(BUT[i].S[0] && BUT[i].S[1])emptyBUT(1 , i,s++);

	if(AC) return;
	BFS(i);
}

int main()
{
  
	
	while (~scanf("%d%d%d",&C[0],&C[1],&goal))
   {

	   tail = AC =0;
	   
	   BUT[0].S[0]=BUT[0].S[1]=0;
	   BUT[0].last = -1;
	   s = 1;
	   BFS(-1);

   }


	return 0;
}


  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
ZJU-I型机械臂是一种由浙江大学机器人研究所开发的六自由度机械臂,具有高速、精度和可靠性等特点。机械臂的运动控制是机器人中的重要研究领域之一,其中点到点轨迹规划是机器人在运动过程中最基础和常用的一种方式,也是机械臂控制的核心问题之一。 点到点轨迹规划的目标是通过给定的起点和终点,计算出机械臂的运动轨迹,使机械臂在运动过程中满足机械臂轨迹的连续性、平滑性、可控性等要求。在过去的研究中,经典的点到点轨迹规划方法包括插值法、线性规划法、最小能量法等。 如果使用Python实现机械臂的点到点轨迹规划,可以采用Robotics Toolkit(简称robot)这个模块。robot模块提供了各种从轨迹规划、控制到仿真的功能,可用于ROS、Vrep、Webots等机器人仿真软件。使用robot模块,可以通过几行代码实现机械臂的点到点轨迹规划,例如: ``` from roboticstoolkit import robot from roboticstoolkit.robots import zju # 初始化机器人 zju_arm = robot.Robot('zju', zju.URDF) # 设定起点和终点 start = [0, 0, 0, 0, 0, 0] goal = [0, 1, 1, 0.5, 0, 0] # 计算机械臂的轨迹 path = zju_arm.get_trajectory(start, goal) # 控制机械臂运动到终点 zju_arm.move_to(goal) ``` 其中,`roboticstoolkit`和`roboticstoolkit.robots`都是导入的Python模块,`zju`是机械臂的URDF定义文件,`start`和`goal`是起点和终点的坐标,`get_trajectory()`函数会返回计算得到的机械臂轨迹,`move_to()`函数则控制机械臂运动到终点。 总之,使用Python实现ZJU-I型机械臂的点到点轨迹规划相对简单,只需要导入相应的模块,并根据需要设置机械臂的各种参数,即可轻松实现机械臂的控制。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值