linse/sics
0
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

using momb as rotating reference

Browse Source 
r3310 | jgn | 2011-12-02 14:50:07 +1100 (Fri, 02 Dec 2011) | 1 line
This commit is contained in:
Jing Chen
2011-12-02 14:50:07 +11:00
committed by Douglas Clowes
parent da1bdd2743
commit ac77e2caa7
1 changed files with 9 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

17
site_ansto/instrument/pelican/config/commands/monodrive.tcl
View File

@@ -100,20 +100,21 @@ proc DriveMono {mot focus} {
# move the three motors # move the three motors
if {$moveFlag == 1} { if {$moveFlag == 1} {
# Unlock the three motors # Unlock the three motors
mra fixed -1 mra fixed 1
mrb fixed -1 mrb fixed 1
mrc fixed -1 mrc fixed 1
drive momb $currAngleMoma momc $currAngleMoma # use momb as roating reference
drive moma $currAngleMomb momc $currAngleMomb
drive mra [expr $mraPosition + $translateDis] drive mra [expr $mraPosition + $translateDis]
drive mrb [expr $mrbPosition + $translateDis] drive mrb [expr $mrbPosition + $translateDis]
drive mrc [expr $mrcPosition + $translateDis] drive mrc [expr $mrcPosition + $translateDis]
drive momb $currAngleMomb momc $currAngleMomc drive moma $currAngleMoma momc $currAngleMomc
# Lock the three motors again # Lock the three motors again
mra fixed 1 mra fixed -1
mrb fixed 1 mrb fixed -1
mrc fixed 1 mrc fixed -1
} }
} }