public void Arminit()
{
TcpserverEx.net_port_initial();
//int card_number = int.Parse("114");
//robot1 = TcpserverEx.get_robot(card_number);
if (robot1.is_connected())
{
int ret = robot1.joint_home(1);
robot1.joint_home(3);
ret = robot1.joint_home(2);
ret = robot1.joint_home(4);
if (ret == 0)
{
DisplayMessage("ARM init error");
}
else
{
DisplayMessage(string.Format("Arm init succes {0}", ret));
}
}
else
{
DisplayMessage("Arm not connected");
}
}
public static void mach()
{
Console.WriteLine("Init");
TcpserverEx.net_port_initial();
ControlBeanEx robot = TcpserverEx.get_robot(59);
Stopwatch watch = Stopwatch.StartNew();
while (!robot.is_connected())
{
Console.Write(".");
Thread.Sleep(1);
}
Console.WriteLine();
Console.WriteLine($"Took {watch.ElapsedMilliseconds}ms to connect!");
//watch.Restart();
Console.WriteLine("Joint home 1: " + robot.joint_home(1));
Console.WriteLine("Joint home 2: " + robot.joint_home(2));
Console.WriteLine("Joint home 3: " + robot.joint_home(3));
Console.WriteLine("Joint home 4: " + robot.joint_home(4));
//Console.ReadKey();
//Console.WriteLine($"Time to Home: {watch.ElapsedMilliseconds}");
//Console.ReadKey();
//while (true)
//{
// if (watch.ElapsedMilliseconds > 15000) break;
// robot.get_scara_param();
// Console.WriteLine(
// $"target: {robot.is_robot_goto_target()}, " +
// $"move flag: {robot.move_flag}, " +
// $"Angle 1: {robot.angle1}, " +
// $"Angle 1 Judge: {robot.angle1_after_judge}, " +
// $"Angle 2: {robot.angle2}, " +
// $"Angle 2 Judge: {robot.angle2_after_judge}, " +
// $"Init Finished: {robot.initial_finish}");
// Thread.Sleep(100);
//}
Thread.Sleep(3000);
// robot.set_arm_length(200, 200); DO NOT SET ARM LENGTH WHEN JOINT_HOME IS RUNNING!!!
Console.WriteLine("Initialize: " + robot.initial(1, 310));
robot.get_scara_param();
Console.WriteLine(robot.initial_finish);
Console.WriteLine("Unlock Position: " + robot.unlock_position());
watch.Restart();
while (true)
{
if (watch.ElapsedMilliseconds > 15000)
{
break;
}
robot.get_scara_param();
Console.WriteLine(
//$"target: {robot.is_robot_goto_target()}, " +
$"move flag: {robot.move_flag}, " +
$"Angle 1: {robot.angle1}, " +
$"Angle 1 Judge: {robot.angle1_after_judge}, " +
$"Angle 2: {robot.angle2}, " +
$"Angle 2 Judge: {robot.angle2_after_judge}, " +
$"Angle 3: {robot.rotation}, " +
$"Init Finished: {robot.initial_finish}");
Thread.Sleep(100);
}
robot.set_catch_or_release_accuracy(0.5f);
//Console.WriteLine("At Home");
//Console.WriteLine("Going Home");
//while (robot.move_flag)
//{
// Console.Write(".");
// Thread.Sleep(1);
//}
//robot.set_arm_length(200, 200);
//robot.set_catch_or_release_accuracy(0.5f);
//Console.WriteLine("Unlock Position: " + robot.unlock_position());
//Console.WriteLine("xyz move: " + robot.xyz_move(1, -10, 50));
// Console.WriteLine("Cooperation State: " + robot.set_cooperation_fun_state(true));
//Console.WriteLine("Drag Teach: " + robot.set_drag_teach(true));
}