-
Notifications
You must be signed in to change notification settings - Fork 1
PID Visualizer for tuning #51
base: main
Are you sure you want to change the base?
Conversation
"python_version": "3.8" | ||
"python_version": "3.10" |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Will have to test this later, a bug in cbor2 was having some issues with python 3.10
Looking awesome! Should be good using this in conjunction with sysid https://docs.wpilib.org/en/stable/docs/software/pathplanning/system-identification/introduction.html |
[ 1.414427764564822, 0.4532788672855945 ], | ||
[ 2.8520270902733444, -0.41329166658587235 ], | ||
[ 3.746129447213704, 0.22670305670487778 ], | ||
[ 4.204252742817587, 0.05700326005055989 ], | ||
[ 5.168114968502579, -0.19496620654409336 ], | ||
[ 6.266934171920824, -0.2959937758374107 ], | ||
[ 7.63454339751726, -0.25613216676177686 ], | ||
[ 8.561594018646465, 0.46773854181686425 ], | ||
[ 9.964721269234046, -0.014820994112597408 ], | ||
[ 10.77702430456722, -0.21419597232751042 ], | ||
[ 11.212606158886956, 0.07755683949986913 ], | ||
[ 12.571600701608348, 0.15113480726434214 ], | ||
[ 13.516059481060054, -0.4873492561424009 ], | ||
[ 14.293595528245058, 0.4600594927657562 ], | ||
[ 15.873553679001017, -0.1317821200267395 ], | ||
[ 16.5689113215901, -0.28137183556135237 ], | ||
[ 17.559804101043813, -0.38189403408025724 ], | ||
[ 18.419667718052526, -0.3537108525044299 ], | ||
[ 19.198339639628376, -0.488414992923242 ], | ||
[ 20.457585605365367, 0.43225855821796966 ], | ||
[ 21.943230082739095, 0.028229188592270305 ], | ||
[ 22.858697137617423, -0.2802298792314497 ], | ||
[ 23.33391186171871, -0.22043083111922024 ], | ||
[ 24.109246139002384, -0.2096253530116432 ], | ||
[ 25.47459783072809, 0.03835507993695231 ], | ||
[ 26.31898267614858, 0.4084136714024742 ], | ||
[ 27.87548760754496, 0.3814858092140514 ], | ||
[ 28.356845182797407, 0.31144505240394604 ], | ||
[ 29.12822409914936, -0.20460371441919678 ], | ||
[ 30.199157972198144, -0.12054564297816706 ], | ||
[ 31.736809722730484, 0.07112447150799994 ], | ||
[ 32.69555194519693, 0.04856344141479085 ], | ||
[ 33.36867801845193, 0.3312664063460069 ], | ||
[ 34.06563158071584, -0.23650163065013752 ], | ||
[ 35.16125792029471, -0.20446763859100758 ], | ||
[ 36.99660594656883, -0.03168776472280044 ], | ||
[ 37.09896595105113, -0.07732581975359687 ], | ||
[ 38.001497442375104, 0.4138012555060142 ], | ||
[ 39.53521089281847, -0.2671142390697472 ], | ||
[ 40.75499218136703, -0.38616241142650587 ], | ||
[ 41.33251172745858, -0.3181915997086968 ], | ||
[ 42.30679657548812, -0.39656394977238385 ], | ||
[ 43.7143823961107, 0.07272472885468884 ], | ||
[ 44.984367355472784, -0.4717395983801711 ], | ||
[ 45.912561784205, 0.05543391432940825 ], | ||
[ 46.668109512255384, -0.0638702760335017 ], | ||
[ 47.714485817719634, -0.46360900247555503 ], | ||
[ 48.40677795913262, -0.37985783829230746 ], | ||
[ 49.2080074864734, -0.08811125039978385 ], | ||
[ 50.775087189922964, 0.23956323521591227 ], | ||
[ 51.53960871003061, 0.4215785100155207 ], | ||
[ 52.637545795633464, -0.40687544687986055 ], | ||
[ 53.058983175071134, -0.20633347896511345 ], | ||
[ 54.52168676337418, 0.28064799749712854 ], | ||
[ 55.59449492133944, -0.23496483443675031 ], | ||
[ 56.752479565932646, -0.3332686825497233 ], | ||
[ 57.87278070551585, -0.14672306939558633 ], | ||
[ 58.194822514781585, -0.2660184724777872 ], | ||
[ 59.66271110047592, 0.31883254827347973 ], | ||
[ 60.275606542226285, 0.2737287660174399 ], | ||
[ 61.60240484525688, 0.123054476288325 ], | ||
[ 62.0620652052864, -0.2261111041777777 ], | ||
[ 63.71643245154369, -0.12400536928021655 ], | ||
[ 64.95043339040197, -0.23931648503120018 ], | ||
[ 65.12750584694706, -0.3543120290489623 ], | ||
[ 66.52278357754915, 0.20111978979944745 ], | ||
[ 67.27592568846507, -0.07941405547085623 ], | ||
[ 68.28255288552806, -0.3607442377384438 ], | ||
[ 69.07288402009651, 0.2178831728122892 ], | ||
[ 70.97294454113036, -0.3751756767131962 ], | ||
[ 71.5733900611219, -0.4212824585349626 ], | ||
[ 72.74196734797206, 0.3722597912919341 ], | ||
[ 73.66986403323605, 0.023616188314581565 ], | ||
[ 74.83835172462865, -0.14684640849386832 ], | ||
[ 75.4334269622398, -0.06571932337776909 ], | ||
[ 76.62504549410902, 0.2808944027768401 ], | ||
[ 77.61260306612888, 0.12497958763148498 ], | ||
[ 78.95470904898487, -0.05637179592885655 ], | ||
[ 79.51627397623926, -0.2619575516815378 ], | ||
[ 80.50399902177124, -0.22019267345717153 ], | ||
[ 81.5780049959997, 0.29363514457252937 ], | ||
[ 82.59049353747326, -0.18354009976141872 ], | ||
[ 83.01421782632444, -0.2679440482599058 ], | ||
[ 84.07831241785533, -0.31843733735377655 ], | ||
[ 85.546834909146, -0.4522788926540584 ], | ||
[ 86.99145513498377, 0.2788336530915032 ], | ||
[ 87.5691748461773, -0.45451481759649837 ], | ||
[ 88.66926851182683, -0.09004214032862667 ], | ||
[ 89.52117458302384, 0.37532568608801786 ], | ||
[ 90.49928797534004, 0.003161564024508623 ], | ||
[ 91.39309175114558, 0.23990372988326358 ], | ||
[ 92.29111904804692, -0.20585969247588998 ], | ||
[ 93.57550496729945, 0.035191573716821356 ], | ||
[ 94.36276308082181, 0.46125752953469545 ], | ||
[ 95.72931862645423, 0.12398002441722711 ], | ||
[ 96.47610322987103, 0.2939709635049641 ], | ||
[ 97.2703463992029, 0.19494143108599982 ], | ||
[ 98.10719548894046, 0.05728472966601306 ], | ||
[ 99.17961451044609, 0.13371026582085643 ] | ||
]; |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
[blackfmt] reported by reviewdog 🐶
[ 0.2533996632758717, -0.35389611653539643 ], | |
[ 1.414427764564822, 0.4532788672855945 ], | |
[ 2.8520270902733444, -0.41329166658587235 ], | |
[ 3.746129447213704, 0.22670305670487778 ], | |
[ 4.204252742817587, 0.05700326005055989 ], | |
[ 5.168114968502579, -0.19496620654409336 ], | |
[ 6.266934171920824, -0.2959937758374107 ], | |
[ 7.63454339751726, -0.25613216676177686 ], | |
[ 8.561594018646465, 0.46773854181686425 ], | |
[ 9.964721269234046, -0.014820994112597408 ], | |
[ 10.77702430456722, -0.21419597232751042 ], | |
[ 11.212606158886956, 0.07755683949986913 ], | |
[ 12.571600701608348, 0.15113480726434214 ], | |
[ 13.516059481060054, -0.4873492561424009 ], | |
[ 14.293595528245058, 0.4600594927657562 ], | |
[ 15.873553679001017, -0.1317821200267395 ], | |
[ 16.5689113215901, -0.28137183556135237 ], | |
[ 17.559804101043813, -0.38189403408025724 ], | |
[ 18.419667718052526, -0.3537108525044299 ], | |
[ 19.198339639628376, -0.488414992923242 ], | |
[ 20.457585605365367, 0.43225855821796966 ], | |
[ 21.943230082739095, 0.028229188592270305 ], | |
[ 22.858697137617423, -0.2802298792314497 ], | |
[ 23.33391186171871, -0.22043083111922024 ], | |
[ 24.109246139002384, -0.2096253530116432 ], | |
[ 25.47459783072809, 0.03835507993695231 ], | |
[ 26.31898267614858, 0.4084136714024742 ], | |
[ 27.87548760754496, 0.3814858092140514 ], | |
[ 28.356845182797407, 0.31144505240394604 ], | |
[ 29.12822409914936, -0.20460371441919678 ], | |
[ 30.199157972198144, -0.12054564297816706 ], | |
[ 31.736809722730484, 0.07112447150799994 ], | |
[ 32.69555194519693, 0.04856344141479085 ], | |
[ 33.36867801845193, 0.3312664063460069 ], | |
[ 34.06563158071584, -0.23650163065013752 ], | |
[ 35.16125792029471, -0.20446763859100758 ], | |
[ 36.99660594656883, -0.03168776472280044 ], | |
[ 37.09896595105113, -0.07732581975359687 ], | |
[ 38.001497442375104, 0.4138012555060142 ], | |
[ 39.53521089281847, -0.2671142390697472 ], | |
[ 40.75499218136703, -0.38616241142650587 ], | |
[ 41.33251172745858, -0.3181915997086968 ], | |
[ 42.30679657548812, -0.39656394977238385 ], | |
[ 43.7143823961107, 0.07272472885468884 ], | |
[ 44.984367355472784, -0.4717395983801711 ], | |
[ 45.912561784205, 0.05543391432940825 ], | |
[ 46.668109512255384, -0.0638702760335017 ], | |
[ 47.714485817719634, -0.46360900247555503 ], | |
[ 48.40677795913262, -0.37985783829230746 ], | |
[ 49.2080074864734, -0.08811125039978385 ], | |
[ 50.775087189922964, 0.23956323521591227 ], | |
[ 51.53960871003061, 0.4215785100155207 ], | |
[ 52.637545795633464, -0.40687544687986055 ], | |
[ 53.058983175071134, -0.20633347896511345 ], | |
[ 54.52168676337418, 0.28064799749712854 ], | |
[ 55.59449492133944, -0.23496483443675031 ], | |
[ 56.752479565932646, -0.3332686825497233 ], | |
[ 57.87278070551585, -0.14672306939558633 ], | |
[ 58.194822514781585, -0.2660184724777872 ], | |
[ 59.66271110047592, 0.31883254827347973 ], | |
[ 60.275606542226285, 0.2737287660174399 ], | |
[ 61.60240484525688, 0.123054476288325 ], | |
[ 62.0620652052864, -0.2261111041777777 ], | |
[ 63.71643245154369, -0.12400536928021655 ], | |
[ 64.95043339040197, -0.23931648503120018 ], | |
[ 65.12750584694706, -0.3543120290489623 ], | |
[ 66.52278357754915, 0.20111978979944745 ], | |
[ 67.27592568846507, -0.07941405547085623 ], | |
[ 68.28255288552806, -0.3607442377384438 ], | |
[ 69.07288402009651, 0.2178831728122892 ], | |
[ 70.97294454113036, -0.3751756767131962 ], | |
[ 71.5733900611219, -0.4212824585349626 ], | |
[ 72.74196734797206, 0.3722597912919341 ], | |
[ 73.66986403323605, 0.023616188314581565 ], | |
[ 74.83835172462865, -0.14684640849386832 ], | |
[ 75.4334269622398, -0.06571932337776909 ], | |
[ 76.62504549410902, 0.2808944027768401 ], | |
[ 77.61260306612888, 0.12497958763148498 ], | |
[ 78.95470904898487, -0.05637179592885655 ], | |
[ 79.51627397623926, -0.2619575516815378 ], | |
[ 80.50399902177124, -0.22019267345717153 ], | |
[ 81.5780049959997, 0.29363514457252937 ], | |
[ 82.59049353747326, -0.18354009976141872 ], | |
[ 83.01421782632444, -0.2679440482599058 ], | |
[ 84.07831241785533, -0.31843733735377655 ], | |
[ 85.546834909146, -0.4522788926540584 ], | |
[ 86.99145513498377, 0.2788336530915032 ], | |
[ 87.5691748461773, -0.45451481759649837 ], | |
[ 88.66926851182683, -0.09004214032862667 ], | |
[ 89.52117458302384, 0.37532568608801786 ], | |
[ 90.49928797534004, 0.003161564024508623 ], | |
[ 91.39309175114558, 0.23990372988326358 ], | |
[ 92.29111904804692, -0.20585969247588998 ], | |
[ 93.57550496729945, 0.035191573716821356 ], | |
[ 94.36276308082181, 0.46125752953469545 ], | |
[ 95.72931862645423, 0.12398002441722711 ], | |
[ 96.47610322987103, 0.2939709635049641 ], | |
[ 97.2703463992029, 0.19494143108599982 ], | |
[ 98.10719548894046, 0.05728472966601306 ], | |
[ 99.17961451044609, 0.13371026582085643 ] | |
]; | |
[0.2533996632758717, -0.35389611653539643], | |
[1.414427764564822, 0.4532788672855945], | |
[2.8520270902733444, -0.41329166658587235], | |
[3.746129447213704, 0.22670305670487778], | |
[4.204252742817587, 0.05700326005055989], | |
[5.168114968502579, -0.19496620654409336], | |
[6.266934171920824, -0.2959937758374107], | |
[7.63454339751726, -0.25613216676177686], | |
[8.561594018646465, 0.46773854181686425], | |
[9.964721269234046, -0.014820994112597408], | |
[10.77702430456722, -0.21419597232751042], | |
[11.212606158886956, 0.07755683949986913], | |
[12.571600701608348, 0.15113480726434214], | |
[13.516059481060054, -0.4873492561424009], | |
[14.293595528245058, 0.4600594927657562], | |
[15.873553679001017, -0.1317821200267395], | |
[16.5689113215901, -0.28137183556135237], | |
[17.559804101043813, -0.38189403408025724], | |
[18.419667718052526, -0.3537108525044299], | |
[19.198339639628376, -0.488414992923242], | |
[20.457585605365367, 0.43225855821796966], | |
[21.943230082739095, 0.028229188592270305], | |
[22.858697137617423, -0.2802298792314497], | |
[23.33391186171871, -0.22043083111922024], | |
[24.109246139002384, -0.2096253530116432], | |
[25.47459783072809, 0.03835507993695231], | |
[26.31898267614858, 0.4084136714024742], | |
[27.87548760754496, 0.3814858092140514], | |
[28.356845182797407, 0.31144505240394604], | |
[29.12822409914936, -0.20460371441919678], | |
[30.199157972198144, -0.12054564297816706], | |
[31.736809722730484, 0.07112447150799994], | |
[32.69555194519693, 0.04856344141479085], | |
[33.36867801845193, 0.3312664063460069], | |
[34.06563158071584, -0.23650163065013752], | |
[35.16125792029471, -0.20446763859100758], | |
[36.99660594656883, -0.03168776472280044], | |
[37.09896595105113, -0.07732581975359687], | |
[38.001497442375104, 0.4138012555060142], | |
[39.53521089281847, -0.2671142390697472], | |
[40.75499218136703, -0.38616241142650587], | |
[41.33251172745858, -0.3181915997086968], | |
[42.30679657548812, -0.39656394977238385], | |
[43.7143823961107, 0.07272472885468884], | |
[44.984367355472784, -0.4717395983801711], | |
[45.912561784205, 0.05543391432940825], | |
[46.668109512255384, -0.0638702760335017], | |
[47.714485817719634, -0.46360900247555503], | |
[48.40677795913262, -0.37985783829230746], | |
[49.2080074864734, -0.08811125039978385], | |
[50.775087189922964, 0.23956323521591227], | |
[51.53960871003061, 0.4215785100155207], | |
[52.637545795633464, -0.40687544687986055], | |
[53.058983175071134, -0.20633347896511345], | |
[54.52168676337418, 0.28064799749712854], | |
[55.59449492133944, -0.23496483443675031], | |
[56.752479565932646, -0.3332686825497233], | |
[57.87278070551585, -0.14672306939558633], | |
[58.194822514781585, -0.2660184724777872], | |
[59.66271110047592, 0.31883254827347973], | |
[60.275606542226285, 0.2737287660174399], | |
[61.60240484525688, 0.123054476288325], | |
[62.0620652052864, -0.2261111041777777], | |
[63.71643245154369, -0.12400536928021655], | |
[64.95043339040197, -0.23931648503120018], | |
[65.12750584694706, -0.3543120290489623], | |
[66.52278357754915, 0.20111978979944745], | |
[67.27592568846507, -0.07941405547085623], | |
[68.28255288552806, -0.3607442377384438], | |
[69.07288402009651, 0.2178831728122892], | |
[70.97294454113036, -0.3751756767131962], | |
[71.5733900611219, -0.4212824585349626], | |
[72.74196734797206, 0.3722597912919341], | |
[73.66986403323605, 0.023616188314581565], | |
[74.83835172462865, -0.14684640849386832], | |
[75.4334269622398, -0.06571932337776909], | |
[76.62504549410902, 0.2808944027768401], | |
[77.61260306612888, 0.12497958763148498], | |
[78.95470904898487, -0.05637179592885655], | |
[79.51627397623926, -0.2619575516815378], | |
[80.50399902177124, -0.22019267345717153], | |
[81.5780049959997, 0.29363514457252937], | |
[82.59049353747326, -0.18354009976141872], | |
[83.01421782632444, -0.2679440482599058], | |
[84.07831241785533, -0.31843733735377655], | |
[85.546834909146, -0.4522788926540584], | |
[86.99145513498377, 0.2788336530915032], | |
[87.5691748461773, -0.45451481759649837], | |
[88.66926851182683, -0.09004214032862667], | |
[89.52117458302384, 0.37532568608801786], | |
[90.49928797534004, 0.003161564024508623], | |
[91.39309175114558, 0.23990372988326358], | |
[92.29111904804692, -0.20585969247588998], | |
[93.57550496729945, 0.035191573716821356], | |
[94.36276308082181, 0.46125752953469545], | |
[95.72931862645423, 0.12398002441722711], | |
[96.47610322987103, 0.2939709635049641], | |
[97.2703463992029, 0.19494143108599982], | |
[98.10719548894046, 0.05728472966601306], | |
[99.17961451044609, 0.13371026582085643], | |
] |
@@ -67,6 +175,7 @@ def __init__(self) -> None: | |||
|
|||
# Get PID controller objects | |||
self.primaryPID = self.primaryYokeMotor.getPIDController() | |||
self.primaryPIDReference = 0 # can't retrieve this from PID, so store manually |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
[blackfmt] reported by reviewdog 🐶
self.primaryPIDReference = 0 # can't retrieve this from PID, so store manually | |
self.primaryPIDReference = 0 # can't retrieve this from PID, so store manually |
self.graph_data = self.pid_NT.getEntry("graph_data"); | ||
self.graph_data.setDoubleArray([0, 0]); |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
[blackfmt] reported by reviewdog 🐶
self.graph_data = self.pid_NT.getEntry("graph_data"); | |
self.graph_data.setDoubleArray([0, 0]); | |
self.graph_data = self.pid_NT.getEntry("graph_data") | |
self.graph_data.setDoubleArray([0, 0]) |
self.shooter_NT = self.pid_NT.getSubTable("shooter") | ||
|
||
# NOTE: you can add additional tables to this array to auto set them up | ||
for [table, motorName] in [[self.primary_yoke_NT, "primary"], [self.shooter_NT, "shooter"]]: |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
[blackfmt] reported by reviewdog 🐶
for [table, motorName] in [[self.primary_yoke_NT, "primary"], [self.shooter_NT, "shooter"]]: | |
for [table, motorName] in [ | |
[self.primary_yoke_NT, "primary"], | |
[self.shooter_NT, "shooter"], | |
]: |
# self.updatePIDForSubsystem(self.portPID, self.shooter_NT) | ||
# TODO: Update to publish shooter PID data. | ||
# self.publishGraphingData(self.portPID) | ||
def publishPIDForSubsystem(self, table, motorName): |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
[blackfmt] reported by reviewdog 🐶
def publishPIDForSubsystem(self, table, motorName): | |
def publishPIDForSubsystem(self, table, motorName): |
networkTableMin = subtable.getEntry("min").getDouble(currentMin) | ||
|
||
if currentP != networkTableP: | ||
pid.setP(networkTableP); |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
[blackfmt] reported by reviewdog 🐶
pid.setP(networkTableP); | |
pid.setP(networkTableP) |
if currentP != networkTableP: | ||
pid.setP(networkTableP); | ||
if currentI != networkTableI: | ||
pid.setI(networkTableI); |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
[blackfmt] reported by reviewdog 🐶
pid.setI(networkTableI); | |
pid.setI(networkTableI) |
if currentI != networkTableI: | ||
pid.setI(networkTableI); | ||
if currentD != networkTableD: | ||
pid.setD(networkTableD); |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
[blackfmt] reported by reviewdog 🐶
pid.setD(networkTableD); | |
pid.setD(networkTableD) |
if currentD != networkTableD: | ||
pid.setD(networkTableD); | ||
if currentFF != networkTableFF: | ||
pid.setFF(networkTableFF); |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
[blackfmt] reported by reviewdog 🐶
pid.setFF(networkTableFF); | |
pid.setFF(networkTableFF) |
if currentFF != networkTableFF: | ||
pid.setFF(networkTableFF); | ||
if currentMaxI != networkTableMaxI: | ||
pid.setIMaxAccum(networkTableMaxI); |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
[blackfmt] reported by reviewdog 🐶
pid.setIMaxAccum(networkTableMaxI); | |
pid.setIMaxAccum(networkTableMaxI) |
No description provided.