cnc-club.ru

Код: Выделить всё

    self.stat = linuxcnc.stat()
    self.coords = []
	
    def parse_ngc_file(self) :
        self.stat.poll()
        f = open("mask.ngc","r")
        f_lines = f.readlines()
        for line in f_lines :
            coords = [str(s) for s in line.split()]
            self.coords.append(coords)

Код: Выделить всё

    def all_other_segments_length(self, line_num) : # distance from now  to Z lift-up point (self.dtg_curr+ all next segment lengths)
#            print "line_num:", line_num, self.coords[line_num-1], self.dtg_curr,self.dtg_prev
            position = self.stat.actual_position
            offset = self.stat.g5x_offset
            self.x0 = position[0]-offset[0]
            self.y0 = position[1]-offset[1]
#            self.z0 = position[2]-offset[2] #actual positions
            if self.coords[line_num-1][0] == "G0" :
		return 0
            
	    dist=float( self.stat.distance_to_go ) # include current segment length
            for parsed_coord in self.coords[line_num-1] : # Positions in G1 command
                    if parsed_coord[0:1] == "X" :
                        self.x0=float(parsed_coord[1:])
                        continue
                    if parsed_coord[0:1] == "Y" :
                        self.y0=float(parsed_coord[1:])
                        continue
#                    if parsed_coord[0:1] == "Z" :
#                        self.z0=float(parsed_coord[1:])
#                        continue
            xi = self.x0
            yi = self.y0
	    print "x0 y0 :", xi,yi
#            zi = self.z0
            i=1
            while self.coords[line_num-1+i][0] not in ( "G0", "M02", "%") : # iteration for all next points  and dist calculation
                    if self.coords[line_num-1+i][0]  not in ( "M64", "M65","G4") : 
                            for parsed_coord in self.coords[line_num-1+i] :
                                    if parsed_coord[0:1] == "X" :
                                        xi=float(parsed_coord[1:])
                                        continue
                                    if parsed_coord[0:1] == "Y" :
                                        yi=float(parsed_coord[1:])
                                        continue
#                                    if parsed_coord[0:1] == "Z" :
#                                        zi=float(parsed_coord[1:])
#                                        continue 
                            dist=dist+math.sqrt((xi-self.x0)**2 + (yi-self.y0)**2) # + (zi-self.z0)**2) # dist calculation
	    	    print "xi yi :", xi,yi
                    self.x0=xi
                    self.y0=yi
#                    self.z0=zi
                    i=i+1                
            return dist