Skip to content

Instantly share code, notes, and snippets.

@syanyong
Last active March 21, 2021 04:29
Show Gist options
  • Save syanyong/8f969d683d663b434289edec21e819c9 to your computer and use it in GitHub Desktop.
Save syanyong/8f969d683d663b434289edec21e819c9 to your computer and use it in GitHub Desktop.
Getting start ROS Python pub.py (Created on Feb 21, 2021)
#!/usr/bin/env python
# -*- coding: utf-8 -*-
import rospy # เรียก Libray จากภายนอก
from geometry_msgs.msg import Twist
import time
vel = Twist() # สร้าง Object สำหรับเปลี่ยนความเร็วหุ่นยนต์
def main (): # ฟังก์ชั่นหลัก
rospy.init_node('turtle_commander', anonymous=False) # Regis Node บน Master
rate = rospy.Rate(10) # คุม Sampling time ของ Node นี้ (Hz)
# สร้างตัวแปร pub สำหรับการ Publish ข้อมูล ไปยัง Topic /turtle1/cmd_vel
pub = rospy.Publisher('/turtle1/cmd_vel', Twist,queue_size=10)
timestart = time.time()
while not rospy.is_shutdown(): # ลูปในการควบคุมหุ่นยนต์
timenow = time.time()
counter = timenow - timestart # สำหรับนับเวลา (หน่วย วินาที)
# TODO
print("Running my turtlesim")
# END
pub.publish(vel)
rate.sleep()
if __name__ == '__main__':
try:
main ()
except rospy.ROSInterruptException:
pass
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment