1

#!/usr/bin/env python

     2

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

     3

     4

# This file is part of Beremiz, a Integrated Development Environment for

     5

# programming IEC 61131-3 automates supporting plcopen standard and CanFestival.

     6

#

     7

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

     8

#

     9

# See COPYING file for copyrights details.

    10

#

    11

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

    12

# modify it under the terms of the GNU General Public License

    13

# as published by the Free Software Foundation; either version 2

    14

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

    15

#

    16

# This program 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

    19

# GNU General Public License for more details.

    20

#

    21

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

    22

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

    23

# Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.

    24

    25

import wx

    26

import time

    27

from types import *

    28

    29

from Viewer import *

    30

    31

def ExtractNextBlocks(block, block_list):

    32

    current_list = [block]

    33

    while len(current_list) > 0:

    34

        next_list = []

    35

        for current in current_list:

    36

            connectors = current.GetConnectors()

    37

            input_connectors = []

    38

            if isinstance(current, LD_PowerRail) and current.GetType() == RIGHTRAIL:

    39

                input_connectors = connectors

    40

            else:

    41

                if "inputs" in connectors:

    42

                    input_connectors = connectors["inputs"]

    43

                if "input" in connectors:

    44

                    input_connectors = [connectors["input"]]

    45

            for connector in input_connectors:

    46

                for wire, handle in connector.GetWires():

    47

                    next = wire.EndConnected.GetParentBlock()

    48

                    if not isinstance(next, LD_PowerRail) and next not in block_list:

    49

                        block_list.append(next)

    50

                        next_list.append(next)

    51

        current_list = next_list

    52

    53

def CalcBranchSize(elements, stops):

    54

    branch_size = 0

    55

    stop_list = stops

    56

    for stop in stops:

    57

        ExtractNextBlocks(stop, stop_list)

    58

    element_tree = {}

    59

    for element in elements:

    60

        if element not in element_tree:

    61

            element_tree[element] = {"parents":["start"], "children":[], "weight":None}

    62

            GenerateTree(element, element_tree, stop_list)

    63

        elif element_tree[element]:

    64

            element_tree[element]["parents"].append("start")

    65

    remove_stops = {"start":[], "stop":[]}

    66

    for element, values in element_tree.items():

    67

        if "stop" in values["children"]:

    68

            removed = []

    69

            for child in values["children"]:

    70

                if child != "stop":

    71

##                    if child in elements:

    72

##                        RemoveElement(child, element_tree)

    73

##                        removed.append(child)

    74

                    if "start" in element_tree[child]["parents"]:

    75

                        if element not in remove_stops["stop"]:

    76

                            remove_stops["stop"].append(element)

    77

                        if child not in remove_stops["start"]:

    78

                            remove_stops["start"].append(child)

    79

            for child in removed:

    80

                values["children"].remove(child)

    81

    for element in remove_stops["start"]:

    82

        element_tree[element]["parents"].remove("start")

    83

    for element in remove_stops["stop"]:

    84

        element_tree[element]["children"].remove("stop")

    85

    for element, values in element_tree.items():

    86

        if values and "stop" in values["children"]:

    87

            CalcWeight(element, element_tree)

    88

            if values["weight"]:

    89

                branch_size += values["weight"]

    90

            else:

    91

                return 1

    92

    #print branch_size

    93

    return branch_size

    94

    95

def RemoveElement(remove, element_tree):

    96

    if remove in element_tree and element_tree[remove]:

    97

        for child in element_tree[remove]["children"]:

    98

            if child != "stop":

    99

                RemoveElement(child, element_tree)

   100

        element_tree.pop(remove)

   101

##        element_tree[remove] = None

   102

   103

def GenerateTree(element, element_tree, stop_list):

   104

    if element in element_tree:

   105

        connectors = element.GetConnectors()

   106

        input_connectors = []

   107

        if isinstance(element, LD_PowerRail) and element.GetType() == RIGHTRAIL:

   108

            input_connectors = connectors

   109

        else:

   110

            if "inputs" in connectors:

   111

                input_connectors = connectors["inputs"]

   112

            if "input" in connectors:

   113

                input_connectors = [connectors["input"]]

   114

        for connector in input_connectors:

   115

            for wire, handle in connector.GetWires():

   116

                next = wire.EndConnected.GetParentBlock()

   117

                if isinstance(next, LD_PowerRail) and next.GetType() == LEFTRAIL or next in stop_list:

   118

##                    for remove in element_tree[element]["children"]:

   119

##                        RemoveElement(remove, element_tree)

   120

##                    element_tree[element]["children"] = ["stop"]

   121

                    element_tree[element]["children"].append("stop")

   122

##                elif element_tree[element]["children"] == ["stop"]:

   123

##                    element_tree[next] = None

   124

                elif next not in element_tree or element_tree[next]:

   125

                    element_tree[element]["children"].append(next)

   126

                    if next in element_tree:

   127

                        element_tree[next]["parents"].append(element)

   128

                    else:

   129

                        element_tree[next] = {"parents":[element], "children":[], "weight":None}

   130

                        GenerateTree(next, element_tree, stop_list)

   131

   132

def CalcWeight(element, element_tree):

   133

    weight = 0

   134

    parts = None

   135

    if element in element_tree:

   136

        for parent in element_tree[element]["parents"]:

   137

            if parent == "start":

   138

                weight += 1

   139

            elif parent in element_tree:

   140

                if not parts:

   141

                    parts = len(element_tree[parent]["children"])

   142

                else:

   143

                    parts = min(parts, len(element_tree[parent]["children"]))

   144

                if not element_tree[parent]["weight"]:

   145

                    CalcWeight(parent, element_tree)

   146

                if element_tree[parent]["weight"]:

   147

                    weight += element_tree[parent]["weight"]

   148

                else:

   149

                    element_tree[element]["weight"] = None

   150

                    return

   151

            else:

   152

                element_tree[element]["weight"] = None

   153

                return

   154

        if not parts:

   155

            parts = 1

   156

        element_tree[element]["weight"] = max(1, weight / parts)

   157

   158

   159

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

   160

#                     Ladder Diagram Graphic elements Viewer class

   161

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

   162

   163

   164

"""

   165

Class derived from Viewer class that implements a Viewer of Ladder Diagram

   166

"""

   167

   168

class LD_Viewer(Viewer):

   169

   170

    def __init__(self, parent, tagname, window, controler, debug = False, instancepath = ""):

   171

        Viewer.__init__(self, parent, tagname, window, controler, debug, instancepath)

   172

        self.Rungs = []

   173

        self.RungComments = []

   174

        self.CurrentLanguage = "LD"

   175

   176

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

   177

#                          Refresh functions

   178

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

   179

   180

    def ResetView(self):

   181

        self.Rungs = []

   182

        self.RungComments = []

   183

        Viewer.ResetView(self)

   184

   185

    def RefreshView(self, variablepanel=True, selection=None):

   186

        Viewer.RefreshView(self, variablepanel, selection)

   187

        if self.GetDrawingMode() != FREEDRAWING_MODE:

   188

            for i, rung in enumerate(self.Rungs):

   189

                bbox = rung.GetBoundingBox()

   190

                if i < len(self.RungComments):

   191

                    if self.RungComments[i]:

   192

                        pos = self.RungComments[i].GetPosition()

   193

                        if pos[1] > bbox.y:

   194

                            self.RungComments.insert(i, None)

   195

                else:

   196

                    self.RungComments.insert(i, None)

   197

   198

    def loadInstance(self, instance, ids, selection):

   199

        Viewer.loadInstance(self, instance, ids, selection)

   200

        if self.GetDrawingMode() != FREEDRAWING_MODE:

   201

            if instance["type"] == "leftPowerRail":

   202

                element = self.FindElementById(instance["id"])

   203

                rung = Graphic_Group(self)

   204

                rung.SelectElement(element)

   205

                self.Rungs.append(rung)

   206

            elif instance["type"] == "rightPowerRail":

   207

                rungs = []

   208

                for connector in instance["inputs"]:

   209

                    for link in connector["links"]:

   210

                        connected = self.FindElementById(link["refLocalId"])

   211

                        rung = self.FindRung(connected)

   212

                        if rung not in rungs:

   213

                            rungs.append(rung)

   214

                if len(rungs) > 1:

   215

                    raise ValueError, _("Ladder element with id %d is on more than one rung.")%instance["id"]

   216

                element = self.FindElementById(instance["id"])

   217

                element_connectors = element.GetConnectors()

   218

                self.Rungs[rungs[0]].SelectElement(element)

   219

                for connector in element_connectors["inputs"]:

   220

                    for wire, num in connector.GetWires():

   221

                        self.Rungs[rungs[0]].SelectElement(wire)

   222

                wx.CallAfter(self.RefreshPosition, element)

   223

            elif instance["type"] in ["contact", "coil"]:

   224

                rungs = []

   225

                for link in instance["inputs"][0]["links"]:

   226

                    connected = self.FindElementById(link["refLocalId"])

   227

                    rung = self.FindRung(connected)

   228

                    if rung not in rungs:

   229

                        rungs.append(rung)

   230

                if len(rungs) > 1:

   231

                    raise ValueError, _("Ladder element with id %d is on more than one rung.")%instance["id"]

   232

                element = self.FindElementById(instance["id"])

   233

                element_connectors = element.GetConnectors() 

   234

                self.Rungs[rungs[0]].SelectElement(element)

   235

                for wire, num in element_connectors["inputs"][0].GetWires():

   236

                    self.Rungs[rungs[0]].SelectElement(wire)

   237

                wx.CallAfter(self.RefreshPosition, element)

   238

            elif instance["type"] == "comment":

   239

                element = self.FindElementById(instance["id"])

   240

                pos = element.GetPosition()

   241

                i = 0

   242

                inserted = False

   243

                while i < len(self.RungComments) and not inserted: 

   244

                    ipos = self.RungComments[i].GetPosition()

   245

                    if pos[1] < ipos[1]:

   246

                        self.RungComments.insert(i, element)

   247

                        inserted = True

   248

                    i += 1

   249

                if not inserted:

   250

                    self.RungComments.append(element)

   251

   252

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

   253

#                          Search Element functions

   254

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

   255

   256

    def FindRung(self, element):

   257

        for i, rung in enumerate(self.Rungs):

   258

            if rung.IsElementIn(element):

   259

                return i

   260

        return None

   261

   262

    def FindElement(self, event, exclude_group = False, connectors = True):

   263

        if self.GetDrawingMode() == FREEDRAWING_MODE:

   264

            return Viewer.FindElement(self, event, exclude_group, connectors)

   265

   266

        dc = self.GetLogicalDC()

   267

        pos = event.GetLogicalPosition(dc)

   268

        if self.SelectedElement and not isinstance(self.SelectedElement, (Graphic_Group, Wire)):

   269

            if self.SelectedElement.HitTest(pos, connectors) or self.SelectedElement.TestHandle(pos) != (0, 0):

   270

                return self.SelectedElement

   271

        elements = []

   272

        for element in self.GetElements(sort_wires=True):

   273

            if element.HitTest(pos, connectors) or element.TestHandle(event) != (0, 0):

   274

                elements.append(element)

   275

        if len(elements) == 1:

   276

            return elements[0]

   277

        elif len(elements) > 1:

   278

            group = Graphic_Group(self)

   279

            for element in elements:

   280

                if self.IsBlock(element):

   281

                    return element

   282

                group.SelectElement(element)

   283

            return group

   284

        return None

   285

   286

    def SearchElements(self, bbox):

   287

        if self.GetDrawingMode() == FREEDRAWING_MODE:

   288

            return Viewer.SearchElements(self, bbox)

   289

   290

        elements = []

   291

        for element in self.Blocks.values() + self.Comments.values():

   292

            if element.IsInSelection(bbox):

   293

                elements.append(element)

   294

        return elements

   295

   296

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

   297

#                          Mouse event functions

   298

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

   299

   300

    def OnViewerLeftDown(self, event):

   301

        if self.GetDrawingMode() == FREEDRAWING_MODE:

   302

            Viewer.OnViewerLeftDown(self, event)

   303

        elif self.Mode == MODE_SELECTION:

   304

            element = self.FindElement(event)

   305

            if self.SelectedElement:

   306

                if not isinstance(self.SelectedElement, Graphic_Group):

   307

                    if self.SelectedElement != element:

   308

                        if self.IsWire(self.SelectedElement):

   309

                            self.SelectedElement.SetSelectedSegment(None)

   310

                        else:

   311

                            self.SelectedElement.SetSelected(False)

   312

                    else:

   313

                        self.SelectedElement = None

   314

                elif element and isinstance(element, Graphic_Group):

   315

                    if self.SelectedElement.GetElements() != element.GetElements():

   316

                        for elt in self.SelectedElement.GetElements():

   317

                            if self.IsWire(elt):

   318

                                elt.SetSelectedSegment(None)

   319

                        self.SelectedElement.SetSelected(False)

   320

                        self.SelectedElement = None

   321

                else:

   322

                    for elt in self.SelectedElement.GetElements():

   323

                        if self.IsWire(elt):

   324

                            elt.SetSelectedSegment(None)

   325

                    self.SelectedElement.SetSelected(False)

   326

                    self.SelectedElement = None

   327

            if element:

   328

                self.SelectedElement = element

   329

                self.SelectedElement.OnLeftDown(event, self.GetLogicalDC(), self.Scaling)

   330

                self.SelectedElement.Refresh()

   331

            else:

   332

                self.rubberBand.Reset()

   333

                self.rubberBand.OnLeftDown(event, self.GetLogicalDC(), self.Scaling)

   334

        event.Skip()

   335

   336

    def OnViewerLeftUp(self, event):

   337

        if self.GetDrawingMode() == FREEDRAWING_MODE:

   338

            Viewer.OnViewerLeftUp(self, event)

   339

        elif self.rubberBand.IsShown():

   340

            if self.Mode == MODE_SELECTION:

   341

                elements = self.SearchElements(self.rubberBand.GetCurrentExtent())

   342

                self.rubberBand.OnLeftUp(event, self.GetLogicalDC(), self.Scaling)

   343

                if len(elements) > 0:

   344

                    self.SelectedElement = Graphic_Group(self)

   345

                    self.SelectedElement.SetElements(elements)

   346

                    self.SelectedElement.SetSelected(True)

   347

        elif self.Mode == MODE_SELECTION and self.SelectedElement:

   348

            dc = self.GetLogicalDC() 

   349

            if not isinstance(self.SelectedElement, Graphic_Group):

   350

                if self.IsWire(self.SelectedElement):

   351

                    result = self.SelectedElement.TestSegment(event.GetLogicalPosition(dc), True)

   352

                    if result and result[1] in [EAST, WEST]:

   353

                        self.SelectedElement.SetSelectedSegment(result[0])

   354

                else:

   355

                    self.SelectedElement.OnLeftUp(event, dc, self.Scaling)

   356

            else:

   357

                for element in self.SelectedElement.GetElements():

   358

                    if self.IsWire(element):

   359

                        result = element.TestSegment(event.GetLogicalPosition(dc), True)

   360

                        if result and result[1] in [EAST, WEST]:

   361

                            element.SetSelectedSegment(result[0])

   362

                    else:

   363

                        element.OnLeftUp(event, dc, self.Scaling)

   364

            self.SelectedElement.Refresh()

   365

            wx.CallAfter(self.SetCurrentCursor, 0)

   366

        event.Skip()

   367

   368

    def OnViewerRightUp(self, event):

   369

        if self.GetDrawingMode() == FREEDRAWING_MODE:

   370

            Viewer.OnViewerRightUp(self, event)

   371

        else:

   372

            element = self.FindElement(event)

   373

            if element:

   374

                if self.SelectedElement and self.SelectedElement != element:

   375

                    self.SelectedElement.SetSelected(False)

   376

                self.SelectedElement = element

   377

                if self.IsWire(self.SelectedElement):

   378

                    self.SelectedElement.SetSelectedSegment(0)

   379

                else:

   380

                    self.SelectedElement.SetSelected(True)

   381

                    self.SelectedElement.OnRightUp(event, self.GetLogicalDC(), self.Scaling)

   382

                    self.SelectedElement.Refresh()

   383

                wx.CallAfter(self.SetCurrentCursor, 0)

   384

        event.Skip()

   385

   386

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

   387

#                          Keyboard event functions

   388

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

   389

   390

    def OnChar(self, event):

   391

        if self.GetDrawingMode() == FREEDRAWING_MODE:

   392

            Viewer.OnChar(self, event)

   393

        else:

   394

            xpos, ypos = self.GetScrollPos(wx.HORIZONTAL), self.GetScrollPos(wx.VERTICAL)

   395

            xmax = self.GetScrollRange(wx.HORIZONTAL) - self.GetScrollThumb(wx.HORIZONTAL)

   396

            ymax = self.GetScrollRange(wx.VERTICAL) - self.GetScrollThumb(wx.VERTICAL)

   397

            keycode = event.GetKeyCode()

   398

            if keycode == wx.WXK_DELETE and self.SelectedElement:

   399

                if self.IsBlock(self.SelectedElement):

   400

                    self.SelectedElement.Delete()

   401

                elif self.IsWire(self.SelectedElement):

   402

                    self.DeleteWire(self.SelectedElement)

   403

                elif isinstance(self.SelectedElement, Graphic_Group):

   404

                    all_wires = True

   405

                    for element in self.SelectedElement.GetElements():

   406

                        all_wires &= self.IsWire(element)

   407

                    if all_wires:

   408

                        self.DeleteWire(self.SelectedElement)

   409

                    else:

   410

                        self.SelectedElement.Delete()

   411

                self.RefreshBuffer()

   412

                self.RefreshScrollBars()

   413

                self.Refresh(False)

   414

            elif keycode == wx.WXK_LEFT:

   415

                if event.ControlDown() and event.ShiftDown():

   416

                    self.Scroll(0, ypos)

   417

                elif event.ControlDown():

   418

                    self.Scroll(max(0, xpos - 1), ypos)

   419

            elif keycode == wx.WXK_RIGHT:

   420

                if event.ControlDown() and event.ShiftDown():

   421

                    self.Scroll(xmax, ypos)

   422

                elif event.ControlDown():

   423

                    self.Scroll(min(xpos + 1, xmax), ypos)

   424

            elif keycode == wx.WXK_UP:

   425

                if event.ControlDown() and event.ShiftDown():

   426

                    self.Scroll(xpos, 0)

   427

                elif event.ControlDown():

   428

                    self.Scroll(xpos, max(0, ypos - 1))

   429

            elif keycode == wx.WXK_DOWN:

   430

                if event.ControlDown() and event.ShiftDown():

   431

                    self.Scroll(xpos, ymax)

   432

                elif event.ControlDown():

   433

                    self.Scroll(xpos, min(ypos + 1, ymax))

   434

            else:

   435

                event.Skip()

   436

   437

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

   438

#                  Model adding functions from Drop Target

   439

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

   440

   441

    def AddVariableBlock(self, x, y, scaling, var_class, var_name, var_type):

   442

        if var_type == "BOOL":

   443

            id = self.GetNewId()

   444

            if var_class == INPUT:

   445

                contact = LD_Contact(self, CONTACT_NORMAL, var_name, id)

   446

                width, height = contact.GetMinSize()

   447

                if scaling is not None:

   448

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

   449

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

   450

                    width = round(float(width) / float(scaling[0]) + 0.5) * scaling[0]

   451

                    height = round(float(height) / float(scaling[1]) + 0.5) * scaling[1]

   452

                contact.SetPosition(x, y)

   453

                contact.SetSize(width, height)

   454

                self.AddBlock(contact)

   455

                self.Controler.AddEditedElementContact(self.GetTagName(), id)

   456

                self.RefreshContactModel(contact)

   457

            else:

   458

                coil = LD_Coil(self, COIL_NORMAL, var_name, id)

   459

                width, height = coil.GetMinSize()

   460

                if scaling is not None:

   461

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

   462

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

   463

                    width = round(float(width) / float(scaling[0]) + 0.5) * scaling[0]

   464

                    height = round(float(height) / float(scaling[1]) + 0.5) * scaling[1]

   465

                coil.SetPosition(x, y)

   466

                coil.SetSize(width, height)

   467

                self.AddBlock(coil)

   468

                self.Controler.AddEditedElementCoil(self.GetTagName(), id)

   469

                self.RefreshCoilModel(coil)

   470

            self.RefreshBuffer()

   471

            self.RefreshScrollBars()

   472

            self.RefreshVisibleElements()

   473

            self.Refresh(False)

   474

        else:

   475

            Viewer.AddVariableBlock(self, x, y, scaling, var_class, var_name, var_type)

   476

   477

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

   478

#                          Adding element functions

   479

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

   480

   481

    def AddLadderRung(self):

   482

        dialog = LDElementDialog(self.ParentWindow, self.Controler, "coil")

   483

        dialog.SetPreviewFont(self.GetFont())

   484

        varlist = []

   485

        vars = self.Controler.GetEditedElementInterfaceVars(self.TagName, debug=self.Debug)

   486

        if vars:

   487

            for var in vars:

   488

                if var.Class != "Input" and var.Type == "BOOL":

   489

                    varlist.append(var.Name)

   490

        returntype = self.Controler.GetEditedElementInterfaceReturnType(self.TagName, debug=self.Debug)

   491

        if returntype == "BOOL":

   492

            varlist.append(self.Controler.GetEditedElementName(self.TagName))

   493

        dialog.SetVariables(varlist)

   494

        dialog.SetValues({"name":"","type":COIL_NORMAL})

   495

        if dialog.ShowModal() == wx.ID_OK:

   496

            values = dialog.GetValues()

   497

            startx, starty = LD_OFFSET[0], 0

   498

            if len(self.Rungs) > 0:

   499

                bbox = self.Rungs[-1].GetBoundingBox()

   500

                starty = bbox.y + bbox.height

   501

            starty += LD_OFFSET[1]

   502

            rung = Graphic_Group(self)

   503

   504

            # Create comment

   505

            id = self.GetNewId()

   506

            comment = Comment(self, _("Comment"), id)

   507

            comment.SetPosition(startx, starty)

   508

            comment.SetSize(LD_COMMENT_DEFAULTSIZE[0], LD_COMMENT_DEFAULTSIZE[1])

   509

            self.AddComment(comment)

   510

            self.RungComments.append(comment)

   511

            self.Controler.AddEditedElementComment(self.TagName, id)

   512

            self.RefreshCommentModel(comment)

   513

            starty += LD_COMMENT_DEFAULTSIZE[1] + LD_OFFSET[1]

   514

   515

            # Create LeftPowerRail

   516

            id = self.GetNewId()

   517

            leftpowerrail = LD_PowerRail(self, LEFTRAIL, id)

   518

            leftpowerrail.SetPosition(startx, starty)

   519

            leftpowerrail_connectors = leftpowerrail.GetConnectors()

   520

            self.AddBlock(leftpowerrail)

   521

            rung.SelectElement(leftpowerrail)

   522

            self.Controler.AddEditedElementPowerRail(self.TagName, id, LEFTRAIL)

   523

            self.RefreshPowerRailModel(leftpowerrail)

   524

   525

            # Create Coil

   526