-
Notifications
You must be signed in to change notification settings - Fork 3
Expand file tree
/
Copy pathpzmap.py
More file actions
94 lines (86 loc) · 3.4 KB
/
Copy pathpzmap.py
File metadata and controls
94 lines (86 loc) · 3.4 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
# pzmap.py - computations involving poles and zeros
#
# Author: Richard M. Murray
# Date: 7 Sep 09
#
# This file contains functions that compute poles, zeros and related
# quantities for a linear system.
#
# Copyright (c) 2009 by California Institute of Technology
# All rights reserved.
#
# Redistribution and use in source and binary forms, with or without
# modification, are permitted provided that the following conditions
# are met:
#
# 1. Redistributions of source code must retain the above copyright
# notice, this list of conditions and the following disclaimer.
#
# 2. Redistributions in binary form must reproduce the above copyright
# notice, this list of conditions and the following disclaimer in the
# documentation and/or other materials provided with the distribution.
#
# 3. Neither the name of the California Institute of Technology nor
# the names of its contributors may be used to endorse or promote
# products derived from this software without specific prior
# written permission.
#
# THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
# "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
# LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
# FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL CALTECH
# OR THE CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
# SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
# LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
# USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
# ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
# OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
# OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
# SUCH DAMAGE.
#
# $Id:pzmap.py 819 2009-05-29 21:28:07Z murray $
import matplotlib.pyplot as plt
#import scipy as sp
#import numpy as np
from numpy import real, imag
from control.lti import Lti
# TODO: Implement more elegant cross-style axes. See:
# http://matplotlib.sourceforge.net/examples/axes_grid/demo_axisline_style.html
# http://matplotlib.sourceforge.net/examples/axes_grid/demo_curvelinear_grid.html
def pzmap(sys, Plot=True, title='Pole Zero Map'):
"""
Plot a pole/zero map for a linear system.
Parameters
----------
sys: Lti (StateSpace or TransferFunction)
Linear system for which poles and zeros are computed.
Plot: bool
If ``True`` a graph is generated with Matplotlib,
otherwise the poles and zeros are only computed and returned.
Returns
-------
pole: array
The systems poles
zeros: array
The system's zeros.
"""
if not isinstance(sys, Lti):
raise TypeError('Argument ``sys``: must be a linear system.')
poles = sys.pole()
zeros = sys.zero()
if (Plot):
# Plot the locations of the poles and zeros
if len(poles) > 0:
plt.scatter(real(poles), imag(poles), s=50, marker='x')
if len(zeros) > 0:
plt.scatter(real(zeros), imag(zeros), s=50, marker='o',
facecolors='none')
# Add axes
#Somewhat silly workaround
plt.axhline(y=0, color='black')
plt.axvline(x=0, color='black')
plt.xlabel('Re')
plt.ylabel('Im')
plt.title(title)
# Return locations of poles and zeros as a tuple
return poles, zeros