Add Monitor and MonitoredSubystem to WPILIb Interface

[aidnem]

Add a Monitor class to monitor whether a certain state is unacceptable for an unacceptable period of time and take action if it is. Also add a MonitoredSubsystem class to check each monitor every time periodic is called.

This has already been described and implemented in 2024-Robot-Code:199.

Scope

• Add Monitor class
• Add MonitoredSubsystem class
• Test it out in sim to see if it works.

[jkleiber]

I think the callback approach is the way to go (see this comment).

The monitored subsystem would live in wpi_interface, but I think the monitor class itself should live in its own package (maybe called "monitors")