高斯六轴机械臂画圆

小弧光

于 2019-03-19 15:33:53 发布

阅读量2.5k

点赞数 1

CC 4.0 BY-SA版权

分类专栏：机械臂机器人

本文链接：https://blog.csdn.net/itfanr/article/details/88663698

#!/usr/bin/env python
# Copyright (c) 2018 Pilz GmbH & Co. KG
#
# This program is free software: you can redistribute it and/or modify
# it under the terms of the GNU Lesser General Public License as published by
# the Free Software Foundation, either version 3 of the License, or
# (at your option) any later version.
#
# This program is distributed in the hope that it will be useful,
# but WITHOUT ANY WARRANTY; without even the implied warranty of
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
# GNU Lesser General Public License for more details.
#
# You should have received a copy of the GNU Lesser General Public License
# along with this program.  If not, see <http://www.gnu.org/licenses/>.

from geometry_msgs.msg import Point
from pilz_robot_programming.robot import *
from pilz_robot_programming.commands import *
import math
import rospy
from time import sleep
import yaml

__REQUIRED_API_VERSION__ = "1"

def start_program():
    print("Exe