max/robotics
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Update

Browse Source
This commit is contained in:
Max Hunt 2020-02-11 00:27:29 +00:00
parent 95b72465a6
commit 0ceb051917
2 changed files with 6 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
bricks_etc.py
View File

@ -110,11 +110,11 @@ target_positions = [{
# 'y':-0.19, # 'y':-0.19,
'y':0.2, 'y':0.2,
'z':0.9, 'z':0.9,
'roll':0, 'roll':radians(90),
# 'pitch':-1.570796, # 'pitch':-1.570796,
'pitch':0, 'pitch':0,
# 'yaw':radians(90) # 'yaw':radians(90)
'yaw':0 'yaw':radians(90)
}, },
{ {
'num':2, 'num':2,

8
main.py
View File

@ -264,10 +264,10 @@ if __name__ == "__main__":
left_place_pos.position.x = left_place_pre.position.x + xpos['z'] left_place_pos.position.x = left_place_pre.position.x + xpos['z']
left_place_pos.position.y = left_place_pre.position.y + xpos['x'] left_place_pos.position.y = left_place_pre.position.y + xpos['x']
left_place_pos.position.z = left_place_pre.position.z + xpos['y'] left_place_pos.position.z = left_place_pre.position.z + xpos['y']
left_place_pos.orientation.x = left_place_pre.orientation.x + zqtr[0] left_place_pos.orientation.x = left_place_pre.orientation.x# + zqtr[0]
left_place_pos.orientation.y = left_place_pre.orientation.y + zqtr[1] left_place_pos.orientation.y = left_place_pre.orientation.y# + zqtr[1]
left_place_pos.orientation.z = left_place_pre.orientation.z + zqtr[2] left_place_pos.orientation.z = left_place_pre.orientation.z# + zqtr[2]
left_place_pos.orientation.w = left_place_pre.orientation.w + zqtr[3] left_place_pos.orientation.w = left_place_pre.orientation.w# + zqtr[3]
left_pnp.place(left_place_pos) left_pnp.place(left_place_pos)