1

#!/usr/bin/env python

     2

# -*- coding: utf-8 -*-

     3

     4

#This file is part of PLCOpenEditor, a library implementing an IEC 61131-3 editor

     5

#based on the plcopen standard. 

     6

#

     7

#Copyright (C) 2007: Edouard TISSERANT and Laurent BESSARD

     8

#

     9

#See COPYING file for copyrights details.

    10

#

    11

#This library is free software; you can redistribute it and/or

    12

#modify it under the terms of the GNU General Public

    13

#License as published by the Free Software Foundation; either

    14

#version 2.1 of the License, or (at your option) any later version.

    15

#

    16

#This library is distributed in the hope that it will be useful,

    17

#but WITHOUT ANY WARRANTY; without even the implied warranty of

    18

#MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU

    19

#General Public License for more details.

    20

#

    21

#You should have received a copy of the GNU General Public

    22

#License along with this library; if not, write to the Free Software

    23

#Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

    24

    25

import wx

    26

from math import *

    27

from types import *

    28

    29

#-------------------------------------------------------------------------------

    30

#                               Common constants

    31

#-------------------------------------------------------------------------------

    32

    33

"""

    34

Definition of constants for dimensions of graphic elements

    35

"""

    36

    37

# FBD and SFC constants

    38

MIN_MOVE = 5                            # Minimum move before starting a element dragging

    39

CONNECTOR_SIZE = 8                      # Size of connectors

    40

BLOCK_LINE_SIZE = 20                    # Minimum size of each line in a block

    41

HANDLE_SIZE = 6                         # Size of the squares for handles

    42

ANCHOR_DISTANCE = 5                     # Distance where wire is automativally attached to a connector

    43

POINT_RADIUS = 2                        # Radius of the point of wire ends

    44

MIN_SEGMENT_SIZE = 2                    # Minimum size of the endling segments of a wire

    45

    46

# LD constants

    47

LD_LINE_SIZE = 40                       # Distance between two lines in a ladder rung

    48

LD_ELEMENT_SIZE = (21, 15)              # Size (width, height) of a ladder element (contact or coil)

    49

LD_WIRE_SIZE = 30                       # Size of a wire between two contact

    50

LD_WIRECOIL_SIZE = 70                   # Size of a wire between a coil and a contact

    51

LD_POWERRAIL_WIDTH = 3                  # Width of a Powerrail

    52

LD_OFFSET = (10, 10)                    # Distance (x, y) between each comment and rung of the ladder

    53

LD_COMMENT_DEFAULTSIZE = (600, 40)      # Size (width, height) of a comment box

    54

    55

# SFC constants

    56

SFC_STEP_DEFAULT_SIZE = (40, 30)        # Default size of a SFC step

    57

SFC_TRANSITION_SIZE = (20, 2)           # Size of a SFC transition

    58

SFC_DEFAULT_SEQUENCE_INTERVAL = 40      # Default size of the interval between two divergence branches

    59

SFC_SIMULTANEOUS_SEQUENCE_EXTRA = 20    # Size of extra lines for simultaneous divergence and convergence

    60

SFC_JUMP_SIZE = (12, 13)                # Size of a SFC jump to step

    61

SFC_WIRE_MIN_SIZE = 25                  # Size of a wire between two elements

    62

SFC_ACTION_MIN_SIZE = (100, 30)         # Minimum size of an action block line

    63

    64

# Type definition constants for graphic elements

    65

[INPUT, OUTPUT, INOUT] = range(3)

    66

[CONNECTOR, CONTINUATION] = range(2)

    67

[LEFTRAIL, RIGHTRAIL] = range(2)

    68

[CONTACT_NORMAL, CONTACT_REVERSE, CONTACT_RISING, CONTACT_FALLING] = range(4)

    69

[COIL_NORMAL, COIL_REVERSE, COIL_SET, COIL_RESET, COIL_RISING, COIL_FALLING] = range(6)

    70

[SELECTION_DIVERGENCE, SELECTION_CONVERGENCE, SIMULTANEOUS_DIVERGENCE, SIMULTANEOUS_CONVERGENCE] = range(4)

    71

    72

# Constants for defining the type of dragging that has been selected

    73

[HANDLE_MOVE, HANDLE_RESIZE, HANDLE_POINT, HANDLE_SEGMENT, HANDLE_CONNECTOR] = range(5)

    74

    75

# List of value for resize handle that are valid

    76

VALID_HANDLES = [(1,1), (1,2), (1,3), (2,3), (3,3), (3,2), (3,1), (2,1)]

    77

    78

# Contants for defining the direction of a connector

    79

[EAST, NORTH, WEST, SOUTH] = [(1,0), (0,-1), (-1,0), (0,1)]

    80

    81

# Contants for defining which mode is selected for each view 

    82

[MODE_SELECTION, MODE_BLOCK, MODE_VARIABLE, MODE_CONNECTION, MODE_COMMENT, 

    83

 MODE_COIL, MODE_CONTACT, MODE_POWERRAIL, MODE_INITIALSTEP, MODE_STEP, 

    84

 MODE_TRANSITION, MODE_DIVERGENCE, MODE_JUMP, MODE_ACTION] = range(14)

    85

    86

# Contants for defining alignment types for graphic group 

    87

[ALIGN_LEFT, ALIGN_CENTER, ALIGN_RIGHT, ALIGN_TOP, ALIGN_MIDDLE, ALIGN_BOTTOM] = range(6)

    88

    89

# Contants for defining which drawing mode is selected for app

    90

[FREEDRAWING_MODE, DRIVENDRAWING_MODE] = [1, 2]

    91

    92

# Color for Highlighting

    93

HIGHLIGHTCOLOR = wx.CYAN

    94

    95

CURSORS = None

    96

    97

def ResetCursors():

    98

    global CURSORS

    99

    if CURSORS == None:

   100

        CURSORS = [wx.NullCursor, 

   101

                   wx.StockCursor(wx.CURSOR_HAND),

   102

                   wx.StockCursor(wx.CURSOR_SIZENWSE),

   103

                   wx.StockCursor(wx.CURSOR_SIZENESW),

   104

                   wx.StockCursor(wx.CURSOR_SIZEWE),

   105

                   wx.StockCursor(wx.CURSOR_SIZENS)]

   106

   107

HANDLE_CURSORS = {

   108

    (1, 1) : 2,

   109

    (3, 3) : 2,

   110

    (1, 3) : 3,

   111

    (3, 1) : 3,

   112

    (1, 2) : 4,

   113

    (3, 2) : 4,

   114

    (2, 1) : 5,

   115

    (2, 3) : 5

   116

}

   117

   128

"""

   129

Basic vector operations for calculate wire points

   130

"""

   131

   132

# Create a vector from two points and define if vector must be normal

   133

def vector(p1, p2, normal = True):

   134

    vector = (p2.x - p1.x, p2.y - p1.y)

   135

    if normal:

   136

        return normalize(vector)

   137

    return vector

   138

   139

# Calculate the norm of a given vector

   140

def norm(v):

   141

    return sqrt(v[0] * v[0] + v[1] * v[1])

   142

   143

# Normalize a given vector

   144

def normalize(v):

   145

    v_norm = norm(v)

   146

    # Verifie if it is not a null vector

   147

    if v_norm > 0:

   148

        return (v[0] / v_norm, v[1] / v_norm)

   149

    else:

   150

        return v

   151

   152

# Calculate the scalar product of two vectors

   153

def is_null_vector(v):

   154

    return v == (0, 0)

   155

   156

# Calculate the scalar product of two vectors

   157

def add_vectors(v1, v2):

   158

    return (v1[0] + v2[0], v1[1] + v2[1])

   159

   160

# Calculate the scalar product of two vectors

   161

def product(v1, v2):

   162

    return v1[0] * v2[0] + v1[1] * v2[1]

   163

   164

   165

"""

   166

Function that calculates the nearest point of the grid defined by scaling for the given point

   167

"""

   168

   169

def GetScaledEventPosition(event, dc, scaling):

   170

    pos = event.GetLogicalPosition(dc)

   171

    if scaling:

   172

        pos.x = round(float(pos.x) / float(scaling[0])) * scaling[0]

   173

        pos.y = round(float(pos.y) / float(scaling[1])) * scaling[1]

   174

    return pos

   175

   176

   177

"""

   178

Function that choose a direction during the wire points generation

   179

"""

   180

   181

def DirectionChoice(v_base, v_target, dir_target):

   182

    dir_product = product(v_base, v_target)

   183

    if dir_product < 0:

   184

        return (-v_base[0], -v_base[1])

   185

    elif dir_product == 0 and product(v_base, dir_target) != 0:

   186

        return dir_target

   187

    return v_base

   188

   189

   190

#-------------------------------------------------------------------------------

   191

#                               Viewer Rubberband

   192

#-------------------------------------------------------------------------------

   193

   194

"""

   195

Class that implements a rubberband

   196

"""

   197

   198

class RubberBand:

   199

   200

    # Create a rubberband by indicated on which window it must be drawn

   201

    def __init__(self, drawingSurface):

   202

        self.drawingSurface = drawingSurface

   203

        self.Reset()

   204

   205

    # Method that initializes the internal attributes of the rubberband

   206

    def Reset(self):

   207

        self.startPoint = None

   208

        self.currentBox = None

   209

        self.lastBox = None

   210

   211

    # Method that return if a box is currently edited

   212

    def IsShown(self):

   213

        return self.currentBox != None

   214

   215

    # Method that returns the currently edited box

   216

    def GetCurrentExtent(self):

   217

        return self.currentBox

   218

   219

    # Method called when a new box starts to be edited

   220

    def OnLeftDown(self, event, dc, scaling):

   221

        pos = GetScaledEventPosition(event, dc, scaling)

   222

        # Save the point for calculate the box position and size

   223

        self.startPoint = pos

   224

        self.currentBox = wx.Rect(pos.x, pos.y, 0, 0)

   225

        self.drawingSurface.SetCursor(wx.StockCursor(wx.CURSOR_CROSS))

   226

        self.Redraw()

   227

   228

    # Method called when dragging with a box edited

   229

    def OnMotion(self, event, dc, scaling):

   230

        pos = GetScaledEventPosition(event, dc, scaling)

   231

        # Save the last position and size of the box for erasing it

   232

        self.lastBox = wx.Rect(self.currentBox.x, self.currentBox.y, self.currentBox.width,

   233

            self.currentBox.height)

   234

        # Calculate new position and size of the box 

   235

        if pos.x >= self.startPoint.x:

   236

            self.currentBox.x = self.startPoint.x

   237

            self.currentBox.width = pos.x - self.startPoint.x + 1

   238

        else:

   239

            self.currentBox.x = pos.x

   240

            self.currentBox.width = self.startPoint.x - pos.x + 1

   241

        if pos.y >= self.startPoint.y:

   242

            self.currentBox.y = self.startPoint.y

   243

            self.currentBox.height = pos.y - self.startPoint.y + 1

   244

        else:

   245

            self.currentBox.y = pos.y

   246

            self.currentBox.height = self.startPoint.y - pos.y + 1

   247

        self.Redraw()

   248

   249

    # Method called when dragging is stopped

   250

    def OnLeftUp(self, event, dc, scaling):

   251

        self.drawingSurface.SetCursor(wx.NullCursor)

   252

        self.lastBox = self.currentBox

   253

        self.currentBox = None

   254

        self.Redraw()

   255

   256

    # Method that erase the last box and draw the new box

   257

    def Redraw(self, dc = None):

   258

        if not dc:

   259

            dc = self.drawingSurface.GetLogicalDC()

   260

        dc.SetPen(wx.Pen(wx.WHITE, 1, wx.DOT))

   261

        dc.SetBrush(wx.TRANSPARENT_BRUSH)

   262

        dc.SetLogicalFunction(wx.XOR)

   263

        if self.lastBox:

   264

            # Erase last box

   265

            dc.DrawRectangle(self.lastBox.x, self.lastBox.y, self.lastBox.width,

   266

                self.lastBox.height)

   267

        if self.currentBox:

   268

            # Draw current box

   269

            dc.DrawRectangle(self.currentBox.x, self.currentBox.y, self.currentBox.width,

   270

                self.currentBox.height)

   271

   272

    # Erase last box

   273

    def Erase(self, dc = None):

   274

        if not dc:

   275

            dc = self.drawingSurface.GetLogicalDC()

   276

        dc.SetPen(wx.Pen(wx.WHITE, 1, wx.DOT))

   277

        dc.SetBrush(wx.TRANSPARENT_BRUSH)

   278

        dc.SetLogicalFunction(wx.XOR)

   279

        if self.lastBox:

   280

            dc.DrawRectangle(self.lastBox.x, self.lastBox.y, self.lastBox.width,

   281

                self.lastBox.height)

   282

   283

    # Draw current box

   284

    def Draw(self, dc = None):

   285

        if not dc:

   286

            dc = self.drawingSurface.GetLogicalDC()

   287

        dc.SetPen(wx.Pen(wx.WHITE, 1, wx.DOT))

   288

        dc.SetBrush(wx.TRANSPARENT_BRUSH)

   289

        dc.SetLogicalFunction(wx.XOR)

   290

        if self.currentBox:

   291

            # Draw current box

   292

            dc.DrawRectangle(self.currentBox.x, self.currentBox.y, self.currentBox.width,

   293

                self.currentBox.height)

   294

   295

#-------------------------------------------------------------------------------

   296

#                    Helper for highlighting error in drawn text

   297

#-------------------------------------------------------------------------------

   298

   299

def HighlightErrorZone(dc, x, y, width, height):

   300

    dc.SetPen(wx.TRANSPARENT_PEN)

   301

    dc.SetLogicalFunction(wx.AND)

   302

    dc.SetBrush(wx.Brush(wx.Colour(0,255,0)))

   303

    dc.DrawRectangle(x, y, width, height)

   304

    dc.SetLogicalFunction(wx.XOR)

   305

    dc.SetBrush(wx.Brush(wx.Colour(255,0,0)))

   306

    dc.DrawRectangle(x, y, width, height)

   307

    dc.SetLogicalFunction(wx.COPY)

   308

   309

#-------------------------------------------------------------------------------

   310

#                           Graphic element base class

   311

#-------------------------------------------------------------------------------

   312

   313

"""

   314

Class that implements a generic graphic element

   315

"""

   316

   317

class Graphic_Element:

   318

   319

    # Create a new graphic element

   320

    def __init__(self, parent, id = None):

   321

        self.Parent = parent

   322

        self.Id = id

   323

        self.oldPos = None

   324

        self.StartPos = None

   325

        self.CurrentDrag = None

   326

        self.Handle = (None,None)

   327

        self.Dragging = False

   328

        self.Selected = False

   329

        self.Highlighted = False

   330

        self.Pos = wx.Point(0, 0)

   331

        self.Size = wx.Size(0, 0)

   332

        self.BoundingBox = wx.Rect(0, 0, 0, 0)

   333

        self.Visible = False

   334

        self.CurrentCursor = 0

   335

        ResetCursors()

   336

   337

    def TestVisible(self, screen):

   338

        self.Visible = self.GetRedrawRect().Intersects(screen)

   339

   340

    def IsVisible(self):

   341

        return self.Visible

   342

   343

    def SpreadCurrent(self):

   344

        pass

   345

   346

    def GetConnectorTranslation(self, element):

   347

        return {}

   348

   349

    def IsOfType(self, type, reference):

   350

        return self.Parent.IsOfType(type, reference)

   351

   352

    def IsEndType(self, type):

   353

        return self.Parent.IsEndType(type)

   354

   355

    def GetDragging(self):

   356

        return self.Dragging

   357

   358

    # Make a clone of this element

   359

    def Clone(self, parent):

   360

        return Graphic_Element(parent, self.Id)

   361

   362

    # Changes the block position

   363

    def SetPosition(self, x, y):

   364

        self.Pos.x = x

   365

        self.Pos.y = y

   366

        self.RefreshConnected()

   367

        self.RefreshBoundingBox()

   368

   369

    # Returns the block position

   370

    def GetPosition(self):

   371

        return self.Pos.x, self.Pos.y

   372

   373

    # Changes the element size

   374

    def SetSize(self, width, height):

   375

        self.Size.SetWidth(width)

   376

        self.Size.SetHeight(height)

   377

        self.RefreshConnectors()

   378

        self.RefreshBoundingBox()

   379

   380

    # Returns the element size

   381

    def GetSize(self):

   382

        return self.Size.GetWidth(), self.Size.GetHeight()

   383

   388

    # Refresh the element Bounding Box

   389

    def RefreshBoundingBox(self):

   390

        self.BoundingBox = wx.Rect(self.Pos.x, self.Pos.y, self.Size[0], self.Size[1])

   391

   392

    # Refresh the element connectors position

   393

    def RefreshConnectors(self):

   394

        pass

   395

   396

    # Refresh the position of wires connected to element inputs and outputs

   397

    def RefreshConnected(self):

   398

        pass

   399

   400

    # Change the parent

   401

    def SetParent(self, parent):

   402

        self.Parent = parent

   403

   404

    # Override this method for defining the method to call for deleting this element

   405

    def Delete(self):

   406

        pass

   407

   408

    # Returns the Id

   409

    def GetId(self):

   410

        return self.Id

   411

   412

    # Returns if the point given is in the bounding box

   413

    def HitTest(self, pt):

   414

        rect = self.BoundingBox

   415

        return rect.InsideXY(pt.x, pt.y)

   416

   417

    # Returns if the point given is in the bounding box

   418

    def IsInSelection(self, rect):

   419

        return rect.InsideXY(self.BoundingBox.x, self.BoundingBox.y) and rect.InsideXY(self.BoundingBox.x + self.BoundingBox.width, self.BoundingBox.y + self.BoundingBox.height)

   420

   421

    # Override this method for refreshing the bounding box

   422

    def RefreshBoundingBox(self):

   423

        pass

   424

   425

    # Returns the bounding box

   426

    def GetBoundingBox(self):

   427

        return self.BoundingBox

   428

   429

    # Returns the RedrawRect

   430

    def GetRedrawRect(self, movex = 0, movey = 0):

   431

        rect = wx.Rect()

   432

        rect.x = self.BoundingBox.x - HANDLE_SIZE - 2 - abs(movex)

   433

        rect.y = self.BoundingBox.y - HANDLE_SIZE - 2 - abs(movey)

   434

        rect.width = self.BoundingBox.width + 2 * (HANDLE_SIZE + abs(movex)) + 4

   435

        rect.height = self.BoundingBox.height + 2 * (HANDLE_SIZE + abs(movey)) + 4

   436

        return rect

   437

   438

    def Refresh(self, rect = None):

   439

        if rect is not None:

   440

            self.Parent.RefreshRect(self.Parent.GetScrolledRect(rect), False)

   441

        else:

   442

            self.Parent.RefreshRect(self.Parent.GetScrolledRect(self.GetRedrawRect()), False)

   443

   444

    # Change the variable that indicates if this element is selected

   445

    def SetSelected(self, selected):

   446

        self.Selected = selected

   447

        self.Refresh()

   448

   449

    # Change the variable that indicates if this element is highlighted

   450

    def SetHighlighted(self, highlighted):

   451

        self.Highlighted = highlighted

   452

        self.Refresh()

   453

   454

    # Test if the point is on a handle of this element

   455

    def TestHandle(self, pt):

   456

        extern_rect = wx.Rect(self.BoundingBox.x - HANDLE_SIZE - 2, self.BoundingBox.y - HANDLE_SIZE - 2, 

   457

            self.BoundingBox.width + 2 * HANDLE_SIZE + 4, self.BoundingBox.height + 2 * HANDLE_SIZE + 4)

   458

        intern_rect = wx.Rect(self.BoundingBox.x - 2, self.BoundingBox.y - 2, 

   459

            self.BoundingBox.width + 4, self.BoundingBox.height + 4)

   460

        # Verify that this element is selected

   461

        if self.Selected and extern_rect.InsideXY(pt.x, pt.y) and not intern_rect.InsideXY(pt.x, pt.y):

   462

            # Find if point is on a handle horizontally

   463

            if self.BoundingBox.x - HANDLE_SIZE - 2 <= pt.x < self.BoundingBox.x - 2:

   464

                handle_x = 1

   465

            elif self.BoundingBox.x + (self.BoundingBox.width - HANDLE_SIZE) / 2 <= pt.x < self.BoundingBox.x + (self.BoundingBox.width + HANDLE_SIZE) / 2:

   466

                handle_x = 2

   467

            elif self.BoundingBox.x + self.BoundingBox.width + 2 <= pt.x < self.BoundingBox.x + self.BoundingBox.width + HANDLE_SIZE + 2:

   468

                handle_x = 3

   469

            else:

   470

                handle_x = 0

   471

            # Find if point is on a handle vertically

   472

            if self.BoundingBox.y - HANDLE_SIZE - 2 <= pt.y < self.BoundingBox.y - 2:

   473

                handle_y = 1

   474

            elif self.BoundingBox.y + (self.BoundingBox.height - HANDLE_SIZE) / 2 <= pt.y < self.BoundingBox.y + (self.BoundingBox.height + HANDLE_SIZE) / 2:

   475

                handle_y = 2

   476

            elif self.BoundingBox.y + self.BoundingBox.height - 2 <= pt.y < self.BoundingBox.y + self.BoundingBox.height + HANDLE_SIZE + 2:

   477

                handle_y = 3

   478

            else:

   479

                handle_y = 0

   480

            # Verify that the result is valid

   481

            if (handle_x, handle_y) in VALID_HANDLES:

   482

                return handle_x, handle_y

   483

        return 0, 0

   484

   485

    # Method called when a LeftDown event have been generated

   486

    def OnLeftDown(self, event, dc, scaling):

   487

        pos = event.GetLogicalPosition(dc)

   488

        # Test if an handle have been clicked

   489

        handle = self.TestHandle(pos)

   490

        # Find which type of handle have been clicked,

   491

        # Save a resize event and change the cursor

   492

        cursor = HANDLE_CURSORS.get(handle, 1)

   493

        if cursor != self.CurrentCursor:

   494

            self.Parent.SetCursor(CURSORS[cursor])

   495

            self.CurrentCursor = cursor

   496

        if cursor > 1:

   497

            self.Handle = (HANDLE_RESIZE, handle)

   498

        else:

   499

            self.Handle = (HANDLE_MOVE, None)

   500

            self.SetSelected(False)

   501

        # Initializes the last position

   502

        self.oldPos = GetScaledEventPosition(event, dc, scaling)

   503

        self.StartPos = wx.Point(self.Pos.x, self.Pos.y)

   504

        self.CurrentDrag = wx.Point(0, 0)

   505

   506

    # Method called when a LeftUp event have been generated

   507

    def OnLeftUp(self, event, dc, scaling):