30 lines
693 B
Python
30 lines
693 B
Python
import hiwonder
|
|
import time
|
|
# from utils.PixelToRealworld.predefinedconstants import *
|
|
from utils.pixel_convert import pixel2robot
|
|
|
|
jetmax = hiwonder.JetMax()
|
|
sucker = hiwonder.Sucker()
|
|
|
|
jetmax.go_home(1)
|
|
time.sleep(1)
|
|
|
|
ort_point = (0, -162.94, 212.8 - 28)
|
|
|
|
new_point = ort_point
|
|
new_point = (new_point[0] , new_point[1] - 80, new_point[2] - 130)
|
|
|
|
ele_point = (-110, -50.94, 75)
|
|
|
|
# px, py = input("请输入像素坐标：").split()
|
|
# px, py = int(px), int(py)
|
|
target = pixel2robot(877, 628)
|
|
print(target)
|
|
|
|
# jetmax.set_position((target[0], target[1], -30), 1)
|
|
# jetmax.set_position((-75.41654829, -156.86319459, 70), 1)
|
|
jetmax.set_position(ele_point, 1)
|
|
time.sleep(1)
|
|
|
|
print(jetmax.position)
|