FANDOM


VIsmach jest biblioteką napisaną w Pythonie, służącą wizualizacji robotów symulowanych w LinuxCNC.

Tutoriale:

http://wiki.linuxcnc.org/cgi-bin/wiki.pl?Vismach

http://linuxcnc.org/docs/ja/html/gui/vismach.html

Aby stworzyć konfigurację bazującą na już istniejącej konfiguracji, należy w terminalu wpisać:

sudo su
cp /usr/bin/rotarydelta /usr/bin/deltagui
chmod +x /usr/bin/deltagui

Potem w folderze /usr/bin wpisujemy w terminalu

sudo gedit deltagui

Aby sprawdzić zmiany dokonane w kodzie, w terminalu wpisujemy:

halrun
loadusr deltagui

Po zmianach w kodzie trzeba wyłączyć i włączyć jeszcze raz wizualizację, w przypadku gdyby nie chciała się włączyć, trzeba wpisać

unloadusr deltagui

Aby załączyć wizualizację, w pliku.hal należy wpisać loadusr deltagui.

Aktualny kod deltagui:

#!/usr/bin/python
#    Copyright 2013 Jeff Epler <jepler@unpythonic.net>
#
#    This program is free software; you can redistribute it and/or modify
#    it under the terms of the GNU General Public License as published by
#    the Free Software Foundation; either version 2 of the License, or
#    (at your option) any later version.
#
#    This program is distributed in the hope that it will be useful,
#    but WITHOUT ANY WARRANTY; without even the implied warranty of
#    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
#    GNU General Public License for more details.
#
#    You should have received a copy of the GNU General Public License
#    along with this program; if not, write to the Free Software
#    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

from vismach import *
import hal
import rotarydeltakins
import sys
# allow overriding variables here, using the command line, like:
# loadusr rotarydelta SOMENAME=123
for setting in sys.argv[1:]: exec setting

c = hal.component("deltagui")
c.newpin("joint0", hal.HAL_FLOAT, hal.HAL_IN)
c.newpin("joint1", hal.HAL_FLOAT, hal.HAL_IN)
c.newpin("joint2", hal.HAL_FLOAT, hal.HAL_IN)
c.newpin("pfr", hal.HAL_FLOAT, hal.HAL_IN)
c.newpin("tl", hal.HAL_FLOAT, hal.HAL_IN)
c.newpin("sl", hal.HAL_FLOAT, hal.HAL_IN)
c.newpin("fr", hal.HAL_FLOAT, hal.HAL_IN)
c['pfr'], c['tl'], c['sl'], c['fr'] = rotarydeltakins.get_geometry()
print "Platform radius = %d" %(c['pfr'])
c['pfr'] = 485
print "New platform radius = %d" %(c['pfr'])

print "Thigh length = %d" %(c['tl'])
c['tl'] = 422
print "New thigh length = %d" %(c['tl'])

print "Shin length = %d" %(c['sl'])
c['sl'] = 640
print "New shin length = %d" %(c['sl'])

print "Foot radius = %d" %(c['fr'])
c['fr'] = 87
print "New foot radius = %d" %(c['fr'])

print(c)
c.ready()

class DeltaTranslate(Collection):
    def __init__(self, parts, comp):
        self.comp = comp
        self.parts = parts
        self.x = self.y = self.z = 0

    def apply(self):
        glPushMatrix()
        rotarydeltakins.set_geometry(self.comp['pfr'], self.comp['tl'], self.comp['sl'], self.comp['fr'])
        f = rotarydeltakins.forward(self.comp['joint0'], self.comp['joint1'], self.comp['joint2'])
        if f is not None:
            self.x = x = f[0]
            self.y = y = f[1]
            self.z = z = f[2]
        else:
            x = self.x
            y = self.y
            z = self.z
        glTranslatef(x, y, z)

    def unapply(self):
        glPopMatrix()

class HexPrismZ(CoordsBase):
    def draw(self):
    z0, z1, h = self.coords()
        h /= cos(pi/6)

        glBegin(GL_TRIANGLE_FAN)
        glNormal3f(0, 0, 1)
        glVertex3f(0, 0, z1)
        for i in range(7):
            d = (2*pi/6) * i
            glVertex3f(h * cos(d), h * sin(d), z1)
        glEnd()

        glBegin(GL_TRIANGLE_FAN)
        glNormal3f(0, 0, -1)
        glVertex3f(0, 0, z0)
        for i in range(7):
            d = (2*pi/6) * i
            glVertex3f(h * cos(d), h * sin(d), z0)
        glEnd()

        glBegin(GL_TRIANGLES)
        for i in range(6):
            d1 = (2*pi/6) * i
            cd1 = h * cos(d1)
            sd1 = h * sin(d1)

            d2 = (2*pi/6) * (i+1)
            cd2 = h * cos(d2)
            sd2 = h * sin(d2)

            glNormal3f(cos(d1), sin(d1), 0)
            glVertex3f(cd1, sd1, z1)
            glVertex3f(cd2, sd2, z0)
            glVertex3f(cd2, sd2, z1)
            glVertex3f(cd1, sd1, z1)
            glVertex3f(cd1, sd1, z0)
            glVertex3f(cd2, sd2, z0)
        glEnd()

def build_joint(angle, joint):
    return Rotate([
    HalTranslate([
        CylinderY(-1, 20, 6, 20),
        HalRotate([
        CylinderX(c, 0, 20, 'tl', 20)
        ], c, joint, 1, 0, 1, 0)
    ], c, "pfr", 1, 0, 0)
    ], angle, 0, 0, 1)

class Strut:
    def __init__(self, platform, angle, component, joint):
        self.platform = platform
        self.angle = radians(angle)
        self.component = component
        self.joint = joint
        self.q = gluNewQuadric()

    def draw(self):
        c = cos(self.angle)
        s = sin(self.angle)
        o = self.component['fr']
        oo = .2 * o
        x0 = self.platform.x + c*o
        sx = oo * -s
        y0 = self.platform.y + s*o
        sy = oo * c
        z0 = self.platform.z
        j = -radians(self.component[self.joint])
        r2 = self.component['pfr'] + self.component['tl'] * cos(j)
        x1 = r2 * cos(self.angle)
        y1 = r2 * sin(self.angle)
    z1 = self.component['tl'] * sin(j)

        d = x1-x0, y1-y0, z1-z0
        mag = sqrt(sum(di*di for di in d))
        dx, dy, dz = (di/mag for di in d)
        L = self.component['sl']
        theta = atan2(dz, hypot(dx,dy))
        phi = atan2(dy, dx)

        glPushMatrix()
        glTranslatef(x0+sx, y0+sy, z0)
        glRotatef(degrees(phi), 0, 0, 1)
        glRotatef(90-degrees(theta), 0, 1, 0)
        self.cylinder(L)
        glPopMatrix()

        glPushMatrix()
        glTranslatef(x0-sx, y0-sy, z0)
        glRotatef(degrees(phi), 0, 0, 1)
        glRotatef(90-degrees(theta), 0, 1, 0)
        self.cylinder(L)
        glPopMatrix()

    def cylinder(self, L):
        gluCylinder(self.q, 20, 20, L, 32, 1)
    # bottom cap
    glRotatef(180,1,0,0)
    gluDisk(self.q, 0, .5, 32, 1)
    glRotatef(180,1,0,0)
    # the top cap needs flipped and translated
    glTranslatef(0,0, L)
    gluDisk(self.q, 0, .5, 32, 1)
       
tooltip = Capture()
    

tool = DeltaTranslate([
    Translate([
        Color((0.7,0,1,1), [
            Translate([tooltip], 0,0,-50),
            HexPrismZ(c, 0, .5, 'fr'),
            CylinderZ(-50, 5, -1.5, 50),
            CylinderZ(-1.5, 50, 1, 60)
        ])
    ], 0, 0, -.5)], c)

red = (1,0,0,1)
green = (0,1,0,1)
blue = (0,0,1,1)

joint0 = Color(red, [build_joint(-90, "joint0")])
joint1 = Color(green, [build_joint(30, "joint1")])
joint2 = Color(blue, [build_joint(150, "joint2")])

work = Capture()

strut0 = Color(red, [Strut(tool, -90, c, "joint0")])
strut1 = Color(green, [Strut(tool, 30, c, "joint1")])
strut2 = Color(blue, [Strut(tool, 150, c, "joint2")])

table = Collection([

Translate([
#CylinderZ(50, c['pfr']+25.5, 40, c['pfr']+30.5),
Color([1,1,0,1],[TriangleXY(-800,-461,800,-461,0,923,15,30)]),
Rotate( [Color(red,[Box(1, -c['pfr']+100, -75, 50, -c['pfr']-100, 37.5)])], 0, 0, 0, 1),
Rotate( [Color(green,[Box(1, -c['pfr']+100, -75, 50, -c['pfr']-100, 37.5)])], 120, 0, 0, 1),
Rotate( [Color(blue,[Box(1, -c['pfr']+100, -75, 50, -c['pfr']-100, 37.5)])], 240, 0, 0, 1)],
0, 0, -3)
model = Collection([table, joint0, joint1, joint2, tool,
strut0, strut1, strut2,
work])
main(model, tooltip, work, 1200,lat=-100,lon=-90)

Ad blocker interference detected!


Wikia is a free-to-use site that makes money from advertising. We have a modified experience for viewers using ad blockers

Wikia is not accessible if you’ve made further modifications. Remove the custom ad blocker rule(s) and the page will load as expected.

Więcej z Fandomu

Losowa wiki