mirror of
https://github.com/OSURoboticsClub/Rover_2017_2018.git
synced 2025-11-08 18:21:15 +00:00
Back to defaults after OMSI. IRIS fully working again.
This commit is contained in:
34
software/ros_packages/rover_control/src/drive_control/drive_control_test.py
Executable file
34
software/ros_packages/rover_control/src/drive_control/drive_control_test.py
Executable file
@@ -0,0 +1,34 @@
|
||||
#!/usr/bin/env python
|
||||
#####################################
|
||||
# Imports
|
||||
#####################################
|
||||
# Python native imports
|
||||
import rospy
|
||||
|
||||
from time import time, sleep
|
||||
|
||||
import serial.rs485
|
||||
import minimalmodbus
|
||||
|
||||
# Custom Imports
|
||||
from rover_control.msg import DriveControlMessage
|
||||
|
||||
rospy.init_node("tester")
|
||||
|
||||
pub = rospy.Publisher("/drive_control/rear", DriveControlMessage, queue_size=1)
|
||||
|
||||
sleep(1)
|
||||
|
||||
|
||||
while True:
|
||||
speed = int(input("Enter Speed: "))
|
||||
|
||||
message = DriveControlMessage()
|
||||
message.first_motor_speed = speed
|
||||
message.first_motor_direction = 1
|
||||
message.second_motor_speed = speed
|
||||
|
||||
pub.publish(message)
|
||||
|
||||
sleep(1)
|
||||
|
||||
Reference in New Issue
Block a user