Team2890/allwpilib
4
0
Fork 0
mirror of https://github.com/wpilibsuite/allwpilib synced 2026-06-20 00:51:42 +00:00
Code Issues Packages Projects Releases Wiki Activity

[wpilib] Reduce usage of NTSendable (#5434)

Browse Source
This commit is contained in:
Gold856
2023-07-24 00:34:49 -04:00
committed by GitHub
parent d125711023
commit 99b88be4f3
11 changed files with 134 additions and 85 deletions
Download Patch File Download Diff File Expand all files Collapse all files

54
wpilibNewCommands/src/main/native/cpp/frc2/command/CommandScheduler.cpp
View File

@@ -13,10 +13,10 @@
#include <hal/FRCUsageReporting.h>
#include <hal/HALBase.h>
#include <networktables/IntegerArrayTopic.h>
#include <networktables/NTSendableBuilder.h>
#include <networktables/StringArrayTopic.h>
#include <wpi/DenseMap.h>
#include <wpi/SmallVector.h>
#include <wpi/sendable/SendableBuilder.h>
#include <wpi/sendable/SendableRegistry.h>
#include "frc2/command/CommandPtr.h"
@@ -454,36 +454,40 @@ void CommandScheduler::RequireUngrouped(
}
}
void CommandScheduler::InitSendable(nt::NTSendableBuilder& builder) {
void CommandScheduler::InitSendable(wpi::SendableBuilder& builder) {
builder.SetSmartDashboardType("Scheduler");
builder.SetUpdateTable(
[this,
namesPub = nt::StringArrayTopic{builder.GetTopic("Names")}.Publish(),
idsPub = nt::IntegerArrayTopic{builder.GetTopic("Ids")}.Publish(),
cancelEntry = nt::IntegerArrayTopic{builder.GetTopic("Cancel")}.GetEntry(
{})]() mutable {
auto toCancel = cancelEntry.Get();
if (!toCancel.empty()) {
for (auto cancel : cancelEntry.Get()) {
uintptr_t ptrTmp = static_cast<uintptr_t>(cancel);
Command* command = reinterpret_cast<Command*>(ptrTmp);
if (m_impl->scheduledCommands.find(command) !=
m_impl->scheduledCommands.end()) {
Cancel(command);
}
}
cancelEntry.Set({});
}
wpi::SmallVector<std::string, 8> names;
wpi::SmallVector<int64_t, 8> ids;
builder.AddStringArrayProperty(
"Names",
[this]() mutable {
std::vector<std::string> names;
for (Command* command : m_impl->scheduledCommands) {
names.emplace_back(command->GetName());
}
return names;
},
nullptr);
builder.AddIntegerArrayProperty(
"Ids",
[this]() mutable {
std::vector<int64_t> ids;
for (Command* command : m_impl->scheduledCommands) {
uintptr_t ptrTmp = reinterpret_cast<uintptr_t>(command);
ids.emplace_back(static_cast<int64_t>(ptrTmp));
}
namesPub.Set(names);
idsPub.Set(ids);
return ids;
},
nullptr);
builder.AddIntegerArrayProperty(
"Cancel", []() { return std::vector<int64_t>{}; },
[this](std::span<const int64_t> toCancel) mutable {
for (auto cancel : toCancel) {
uintptr_t ptrTmp = static_cast<uintptr_t>(cancel);
Command* command = reinterpret_cast<Command*>(ptrTmp);
if (m_impl->scheduledCommands.find(command) !=
m_impl->scheduledCommands.end()) {
Cancel(command);
}
}
});
}