mirror of
https://github.com/wpilibsuite/allwpilib
synced 2026-06-20 00:51:42 +00:00
[glass, wpilib] Rewrite Mechanism2d (#3281)
Substantially improves Mechanism2d by moving it to NetworkTables and adding a robot API to create the mechanism elements, instead of requiring a JSON file. Co-authored-by: Peter Johnson <johnson.peter@gmail.com>
This commit is contained in:
@@ -1,41 +0,0 @@
|
||||
// Copyright (c) FIRST and other WPILib contributors.
|
||||
// Open Source Software; you can modify and/or share it under the terms of
|
||||
// the WPILib BSD license file in the root directory of this project.
|
||||
|
||||
#include "frc/simulation/Mechanism2D.h"
|
||||
|
||||
#include <wpi/SmallString.h>
|
||||
#include <wpi/Twine.h>
|
||||
#include <wpi/raw_ostream.h>
|
||||
|
||||
using namespace frc;
|
||||
|
||||
Mechanism2D::Mechanism2D() : m_device{"Mechanism2D"} {}
|
||||
|
||||
void Mechanism2D::SetLigamentAngle(const wpi::Twine& ligamentPath,
|
||||
float angle) {
|
||||
if (m_device) {
|
||||
wpi::SmallString<64> fullPathBuf;
|
||||
wpi::StringRef fullPath =
|
||||
(ligamentPath + "/angle").toNullTerminatedStringRef(fullPathBuf);
|
||||
if (!createdItems.count(fullPath)) {
|
||||
createdItems[fullPath] =
|
||||
m_device.CreateDouble(fullPath.data(), false, angle);
|
||||
}
|
||||
createdItems[fullPath].Set(angle);
|
||||
}
|
||||
}
|
||||
|
||||
void Mechanism2D::SetLigamentLength(const wpi::Twine& ligamentPath,
|
||||
float length) {
|
||||
if (m_device) {
|
||||
wpi::SmallString<64> fullPathBuf;
|
||||
wpi::StringRef fullPath =
|
||||
(ligamentPath + "/length").toNullTerminatedStringRef(fullPathBuf);
|
||||
if (!createdItems.count(fullPath)) {
|
||||
createdItems[fullPath] =
|
||||
m_device.CreateDouble(fullPath.data(), false, length);
|
||||
}
|
||||
createdItems[fullPath].Set(length);
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user