#! /usr/bin/python3

baudRate = 115200
port = "/dev/ttyACM0"

import sys
sys.path.append("../src/open_motor/")
# This line points the python path to the open_motor module.
# This will need to be changed based on the location of your code.

from open_motor_serial import open_motor
import time

comms = open_motor()
comms.init_serial_port(port,baudRate,0.5)

def main():
    while True:
        
        comms.send_pos_goal(0,0,0,0)
        print("Response:" + comms.get_response())
        time.sleep(1.5)

        comms.send_pos_goal(-100,-100,-100,-100)
        print("Response:" + comms.get_response())
        time.sleep(1.5)

        comms.send_pos_goal(0,0,0,0)
        print("Response:" + comms.get_response())
        time.sleep(1.5)


if __name__ == "__main__":
    main()


#! /usr/bin/python3

baudRate = 115200
port = "/dev/ttyACM0"

import sys
sys.path.append("../src/open_motor/")
# This line points the python path to the open_motor module.
# This will need to be changed based on the location of your code.

from open_motor_serial import open_motor
import time

comms = open_motor()
comms.init_serial_port(port,baudRate,0.5)

def main():
    while True:
        
        comms.send_pos_goal(0,0,0,0)
        print("Response:" + comms.get_response())
        time.sleep(1.5)

        comms.send_pos_goal(-100,-100,-100,-100)
        print("Response:" + comms.get_response())
        time.sleep(1.5)

        comms.send_pos_goal(0,0,0,0)
        print("Response:" + comms.get_response())
        time.sleep(1.5)


if __name__ == "__main__":
    main()


#! /usr/bin/python3 # This line points the python path to the open_motor module. # This will need to be changed based on the location of your code.