Tool offset

def index_fanuc_lathe_tool(self,**words):
    # only run this if we are really moving the machine
    # skip this if running task for the screen
    if not self.task:
        return INTERP_OK
    try:
        # check there is a tool number from the Gcode
        cblock = self.blocks[self.remap_level]
        if not cblock.t_flag:
            self.set_errormsg("T requires a tool number")
            return INTERP_ERROR
        tool_raw = int(cblock.t_number)

        # If it's less then 100 someone forgot to add the wear #, so we added it automatically
        # separate out tool number (tool) and wear number (wear), add 10000 to wear number
        if tool_raw <100:
            tool_raw=tool_raw*100
        tool = int(tool_raw/100)
        wear = 10000 + tool_raw % 100

        # uncomment for debugging
        # print'***tool#',cblock.t_number,'toolraw:',tool_raw,'tool split:',tool,'wear split',wear

        # set HAL pins
        self.h["tool-number"] = cblock.t_number
        self.h["tool-wear-number"] = wear

        # check for tool number entry in tool file
        (status, pocket) = self.find_tool_pocket(tool)
        if status != INTERP_OK:
            self.set_errormsg("T%d: tool entry not found" % (tool))
            return status

        # if there is a wear number, check for it in the tool file
        # For wear offset 00, we dont require a tool 10000 entry in the tool file - so we will skip this check
        if wear>10000:
            (status, pocket) = self.find_tool_pocket(wear)
            if status != INTERP_OK:
                self.set_errormsg("T%d: wear entry not found" % (wear))
                return status

        # index tool immediately to tool number
        # immediately add tool offset
        self.selected_tool = self.selected_pocket = tool
        emccanon.SELECT_POCKET(self.selected_pocket, self.selected_tool)
        self.execute("m6")
        self.execute("g43 h%d"% tool)
        # record the x and z offsets of the current tool
        x1= float(self.tool_offset.x)
        z1= float(self.tool_offset.z)

        # if the wear offset is specified, immediately add it's offset
        if wear>10000:
            self.execute("g43.2 h%d"% wear)
        # Not sure why but must call this again to resynch, other wise
        # ;py,print self.tool_table[0].toolno (in mdi) will always be one tool behind
        self.execute("m6")

        # calculate wear offset and set HAL pins 
        self.h["tool-offset-x"] = x1
        self.h["tool-offset-z"] = z1
        self.h["tool-wear-offset-x"] = (float(self.tool_offset.x) -x1)
        self.h["tool-wear-offset-z"] = (float(self.tool_offset.z) -z1)
        # all good
        return INTERP_OK
    except Exception, e:
        self.set_errormsg("T%d index_fanuc_lathe_tool: %s" % (int(words['t']), e))
        return INTERP_ERROR