diff --git a/site_ansto/instrument/pelican/config/commands/monodrive.tcl b/site_ansto/instrument/pelican/config/commands/monodrive.tcl index cf0b0620..66883a78 100644 --- a/site_ansto/instrument/pelican/config/commands/monodrive.tcl +++ b/site_ansto/instrument/pelican/config/commands/monodrive.tcl @@ -100,24 +100,25 @@ proc DriveMono {mot focus} { # move the three motors if {$moveFlag == 1} { # Unlock the three motors - mra fixed 1 - mrb fixed 1 - mrc fixed 1 + mra fixed -1 + mrb fixed -1 + mrc fixed -1 - # use momb as roating reference - drive moma $currAngleMomb momc $currAngleMomb + drive momb $currAngleMoma momc $currAngleMoma drive mra [expr $mraPosition + $translateDis] drive mrb [expr $mrbPosition + $translateDis] drive mrc [expr $mrcPosition + $translateDis] - drive moma $currAngleMoma momc $currAngleMomc + drive momb $currAngleMomb momc $currAngleMomc # Lock the three motors again - mra fixed -1 - mrb fixed -1 - mrc fixed -1 + mra fixed 1 + mrb fixed 1 + mrc fixed 1 } } + + publish DriveMono user