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) 2012: 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

    26

from __future__ import absolute_import

    27

from datetime import timedelta

    28

import binascii

    29

import numpy as np

    30

from graphics.DebugDataConsumer import DebugDataConsumer, TYPE_TRANSLATOR

    31

from controls.DebugVariablePanel.RingBuffer import RingBuffer

    32

    33

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

    34

#                 Constant for calculate CRC for string variables

    35

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

    36

    37

STRING_CRC_SIZE = 8

    38

STRING_CRC_MASK = 2 ** STRING_CRC_SIZE - 1

    39

    40

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

    41

#                          Debug Variable Item Class

    42

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

    43

    44

    45

class DebugVariableItem(DebugDataConsumer):

    46

    """

    47

    Class that implements an element that consumes debug values for PLC variable and

    48

    stores received values for displaying them in graphic panel or table

    49

    """

    50

    51

    def __init__(self, parent, variable, store_data=False):

    52

        """

    53

        Constructor

    54

        @param parent: Reference to debug variable panel

    55

        @param variable: Path of variable to debug

    56

        """

    57

        DebugDataConsumer.__init__(self)

    58

    59

        self.Parent = parent

    60

        self.Variable = variable

    61

        self.StoreData = store_data

    62

    63

        # Get Variable data type

    64

        self.RefreshVariableType()

    65

    66

    def __del__(self):

    67

        """

    68

        Destructor

    69

        """

    70

        # Reset reference to debug variable panel

    71

        self.Parent = None

    72

    73

    def SetVariable(self, variable):

    74

        """

    75

        Set path of variable

    76

        @param variable: Path of variable to debug

    77

        """

    78

        if self.Parent is not None and self.Variable != variable:

    79

            # Store variable path

    80

            self.Variable = variable

    81

            # Get Variable data type

    82

            self.RefreshVariableType()

    83

    84

            # Refresh debug variable panel

    85

            self.Parent.RefreshView()

    86

    87

    def GetVariable(self, mask=None):

    88

        """

    89

        Return path of variable

    90

        @param mask: Mask to apply to variable path [var_name, '*',...]

    91

        @return: String containing masked variable path

    92

        """

    93

        # Apply mask to variable name

    94

        if mask is not None:

    95

            # '#' correspond to parts that are different between all items

    96

    97

            # Extract variable path parts

    98

            parts = self.Variable.split('.')

    99

            # Adjust mask size to size of variable path

   100

            mask = mask + ['*'] * max(0, len(parts) - len(mask))

   101

   102

            # Store previous mask

   103

            last = None

   104

            # Init masked variable path

   105

            variable = ""

   106

   107

            for m, p in zip(mask, parts):

   108

                # Part is not masked, add part prefixed with '.' is previous

   109

                # wasn't masked

   110

                if m == '*':

   111

                    variable += ('.' if last == '*' else '') + p

   112

   113

                # Part is mask, add '..' if first or previous wasn't masked

   114

                elif last is None or last == '*':

   115

                    variable += '..'

   116

   117

                last = m

   118

   119

            return variable

   120

   121

        return self.Variable

   122

   123

    def RefreshVariableType(self):

   124

        """

   125

        Get and store variable data type

   126

        """

   127

        self.VariableType = self.Parent.GetDataType(self.Variable)

   128

        # Reset data stored

   129

        self.ResetData()

   130

   131

    def GetVariableType(self):

   132

        """

   133

        Return variable data type

   134

        @return: Variable data type

   135

        """

   136

        return self.VariableType

   137

   138

    def GetData(self, start_tick=None, end_tick=None):

   139

        """

   140

        Return data stored contained in given range

   141

        @param start_tick: Start tick of given range (default None, first data)

   142

        @param end_tick: end tick of given range (default None, last data)

   143

        @return: Data as numpy.array([(tick, value, forced),...])

   144

        """

   145

        # Return immediately if data empty or none

   146

        if self.Data is None or self.Data.count == 0:

   147

            return None

   148

   149

        # Find nearest data outside given range indexes

   150

        start_idx = (self.GetNearestData(start_tick, -1)

   151

                     if start_tick is not None

   152

                     else 0)

   153

        end_idx = (self.GetNearestData(end_tick, 1)

   154

                   if end_tick is not None

   155

                   else self.Data.count)

   156

   157

        # Return data between indexes

   158

        return self.Data.view[start_idx:end_idx]

   159

   160

    def GetRawValue(self, index):

   161

        """

   162

        Return raw value at given index for string variables

   163

        @param index: Variable value index

   164

        @return: Variable data type

   165

        """

   166

        if self.VariableType in ["STRING", "WSTRING"] and index < len(self.RawData):

   167

            return self.RawData[index][0]

   168

        return ""

   169

   170

    def GetValueRange(self):

   171

        """

   172

        Return variable value range

   173

        @return: (minimum_value, maximum_value)

   174

        """

   175

        return self.MinValue, self.MaxValue

   176

   177

    def GetDataAndValueRange(self, start_tick, end_tick, full_range=True):

   178

        """

   179

        Return variable data and value range for a given tick range

   180

        @param start_tick: Start tick of given range (default None, first data)

   181

        @param end_tick: end tick of given range (default None, last data)

   182

        @param full_range: Value range is calculated on whole data (False: only

   183

        calculated on data in given range)

   184

        @return: (numpy.array([(tick, value, forced),...]),

   185

                  min_value, max_value)

   186

        """

   187

        # Get data in given tick range

   188

        data = self.GetData(start_tick, end_tick)

   189

   190

        # Value range is calculated on whole data

   191

        if full_range:

   192

            return data, self.MinValue, self.MaxValue

   193

   194

        # Check that data in given range is not empty

   195

        values = data[:, 1]

   196

        if len(values) > 0:

   197

            # Return value range for data in given tick range

   198

            return (data,

   199

                    data[np.argmin(values), 1],

   200

                    data[np.argmax(values), 1])

   201

   202

        # Return default values

   203

        return data, None, None

   204

   205

    def ResetData(self):

   206

        """

   207

        Reset data stored when store data option enabled

   208

        """

   209

        if self.StoreData and self.IsNumVariable():

   210

            # Init table storing data

   211

            self.Data = RingBuffer(3)

   212

   213

            # Init table storing raw data if variable is strin

   214

            self.RawData = ([]

   215

                            if self.VariableType in ["STRING", "WSTRING"]

   216

                            else None)

   217

   218

            # Init Value range variables

   219

            self.MinValue = None

   220

            self.MaxValue = None

   221

   222

        else:

   223

            self.Data = None

   224

            self.MinValue = None

   225

            self.MaxValue = None

   226

        # Init variable value

   227

        self.Value = ""

   228

   229

    def IsNumVariable(self):

   230

        """

   231

        Return if variable data type is numeric. String variables are

   232

        considered as numeric (string CRC). Time variables are considered

   233

        as number of seconds

   234

        @return: True if data type is numeric

   235

        """

   236

        return (self.Parent.IsNumType(self.VariableType) or

   237

                self.VariableType in ["STRING", "WSTRING", "TIME", "TOD", "DT", "DATE"])

   238

   239

    def NewValues(self, ticks, values):

   240

        """

   241

        Function called by debug thread when a new debug value is available

   242

        @param tick: PLC tick when value was captured

   243

        @param value: Value captured

   244

        @param forced: Forced flag, True if value is forced (default: False)

   245

        """

   246

        DebugDataConsumer.NewValues(self, ticks[-1], values[-1], raw=None)

   247

   248

        if self.Data is not None:

   249

   250

            if self.VariableType in ["STRING", "WSTRING"]:

   251

                last_raw_data = (self.RawData[-1]

   252

                                 if len(self.RawData) > 0 else None)

   253

                last_raw_data_idx = len(self.RawData) - 1

   254

   255

            data_values = []

   256

            for tick, (value, forced) in zip(ticks, values):

   257

                # Translate forced flag to float for storing in Data table

   258

                forced_value = float(forced)

   259

   260

                if self.VariableType in ["STRING", "WSTRING"]:

   261

                    # String data value is CRC

   262

                    num_value = (binascii.crc32(value) & STRING_CRC_MASK)

   263

                elif self.VariableType in ["TIME", "TOD", "DT", "DATE"]:

   264

                    # Numeric value of time type variables

   265

                    # is represented in seconds

   266

                    num_value = float(value.total_seconds())

   267

                else:

   268

                    num_value = float(value)

   269

   270

                # Update variable range values

   271

                self.MinValue = (min(self.MinValue, num_value)

   272

                                 if self.MinValue is not None

   273

                                 else num_value)

   274

                self.MaxValue = (max(self.MaxValue, num_value)

   275

                                 if self.MaxValue is not None

   276

                                 else num_value)

   277

   278

                # In the case of string variables, we store raw string value and

   279

                # forced flag in raw data table. Only changes in this two values

   280

                # are stored. Index to the corresponding raw value is stored in

   281

                # data third column

   282

                if self.VariableType in ["STRING", "WSTRING"]:

   283

                    raw_data = (value, forced_value)

   284

                    if len(self.RawData) == 0 or last_raw_data != raw_data:

   285

                        last_raw_data_idx += 1

   286

                        last_raw_data = raw_data

   287

                        self.RawData.append(raw_data)

   288

                    extra_value = last_raw_data_idx

   289

   290

                # In other case, data third column is forced flag

   291

                else:

   292

                    extra_value = forced_value

   293

   294

                data_values.append(

   295

                    [float(tick), num_value, extra_value])

   296

   297

            # Add New data to stored data table

   298

            self.Data.append(data_values)

   299

   300

            # Signal to debug variable panel to refresh

   301

            self.Parent.HasNewData = True

   302

   303

    def SetForced(self, forced):

   304

        """

   305

        Update Forced flag

   306

        @param forced: New forced flag

   307

        """

   308

        # Store forced flag

   309

        if self.Forced != forced:

   310

            self.Forced = forced

   311

   312

            # Signal to debug variable panel to refresh

   313

            self.Parent.HasNewData = True

   314

   315

    def SetValue(self, value):

   316

        """

   317

        Update value.

   318

        @param value: New value

   319

        """

   320

        # Remove quote and double quote surrounding string value to get raw value

   321

        if self.VariableType == "STRING" and value.startswith("'") and value.endswith("'") or \

   322

           self.VariableType == "WSTRING" and value.startswith('"') and value.endswith('"'):

   323

            value = value[1:-1]

   324

   325

        # Store variable value

   326

        if self.Value != value:

   327

            self.Value = value

   328

   329

            # Signal to debug variable panel to refresh

   330

            self.Parent.HasNewData = True

   331

   332

    def GetValue(self, tick=None, raw=False):

   333

        """

   334

        Return current value or value and forced flag for tick given

   335

        @return: Current value or value and forced flag

   336

        """

   337

        # If tick given and stored data option enabled

   338

        if tick is not None and self.Data is not None:

   339

   340

            # Return current value and forced flag if data empty

   341

            if self.Data.count == 0:

   342

                return self.Value, self.IsForced()

   343

   344

            # Get index of nearest data from tick given

   345

            idx = self.GetNearestData(tick, 0)

   346

   347

            # Get value and forced flag at given index

   348

            value, forced = \

   349

                self.RawData[int(self.Data.view[idx, 2])] \

   350

                if self.VariableType in ["STRING", "WSTRING"] \

   351

                else self.Data.view[idx, 1:3]

   352

   353

            if self.VariableType in ["TIME", "TOD", "DT", "DATE"]:

   354

                value = timedelta(seconds=value)

   355

   356

            # Get raw value if asked

   357

            if not raw:

   358

                value = TYPE_TRANSLATOR.get(

   359

                    self.VariableType, str)(value)

   360

   361

            return value, forced

   362

   363

        # Return raw value if asked

   364

        if not raw and self.VariableType in ["STRING", "WSTRING"]:

   365

            return TYPE_TRANSLATOR.get(

   366

                self.VariableType, str)(self.Value)

   367

        return self.Value

   368

   369

    def GetNearestData(self, tick, adjust):

   370

        """

   371

        Return index of nearest data from tick given

   372

        @param tick: Tick where find nearest data

   373

        @param adjust: Constraint for data position from tick

   374

                       -1: older than tick

   375

                       1:  newer than tick

   376

                       0:  doesn't matter

   377

        @return: Index of nearest data

   378

        """

   379

        # Return immediately if data is empty

   380

        if self.Data is None:

   381

            return None

   382

   383

        # Extract data ticks

   384

        ticks = self.Data.view[:, 0]

   385

   386

        # Get nearest data from tick

   387

        idx = min(np.searchsorted(ticks, tick), self.Data.count - 1)

   388

   389

        # Adjust data index according to constraint

   390

        if adjust < 0 and ticks[idx] > tick and idx > 0 or \

   391

           adjust > 0 and ticks[idx] < tick and idx < len(ticks):

   392

            idx += adjust

   393

   394

        return idx