11package pioneer
22
33import com.qualcomm.robotcore.hardware.HardwareMap
4- import pioneer.hardware.impl.AprilTagImpl
5- import pioneer.hardware.impl.BatteryMonitorImpl
6- import pioneer.hardware.impl.CameraImpl
7- import pioneer.hardware.impl.FlywheelImpl
8- import pioneer.hardware.impl.LaunchServosImpl
9- import pioneer.hardware.impl.MecanumBaseImpl
10- import pioneer.hardware.interfaces.BatteryMonitor
11- import pioneer.hardware.interfaces.Camera
12- import pioneer.hardware.interfaces.Flywheel
13- import pioneer.hardware.interfaces.LaunchServos
14- import pioneer.hardware.interfaces.MecanumBase
15- import pioneer.hardware.mock.AprilTagMock
16- import pioneer.hardware.mock.BatteryMonitorMock
17- import pioneer.hardware.mock.CameraMock
18- import pioneer.hardware.mock.FlywheelMock
19- import pioneer.hardware.mock.LaunchServosMock
20- import pioneer.hardware.mock.MecanumBaseMock
4+ import org.firstinspires.ftc.vision.apriltag.AprilTagProcessor
5+ import pioneer.hardware.AprilTag
6+ import pioneer.hardware.BatteryMonitor
7+ import pioneer.hardware.Camera
8+ import pioneer.hardware.Flywheel
9+ import pioneer.hardware.LaunchServos
10+ import pioneer.hardware.MecanumBase
11+ import pioneer.hardware.MockHardware
2112import pioneer.localization.Localizer
2213import pioneer.localization.localizers.LocalizerMock
2314import pioneer.localization.localizers.Pinpoint
2415import pioneer.pathing.follower.Follower
25- import org.firstinspires.ftc.vision.apriltag.AprilTagProcessor
16+ import pioneer.constants.Camera as CameraConstants
2617
2718enum class BotType (val supportsLocalizer : Boolean ) {
2819 BASIC_MECANUM_BOT (false ),
@@ -35,17 +26,17 @@ class Bot(
3526 hardwareMap : HardwareMap ,
3627) {
3728 // Basic hardware components
38- var mecanumBase: MecanumBase = MecanumBaseMock ( )
29+ var mecanumBase: MecanumBase = MecanumBase ( MockHardware () )
3930 var localizer: Localizer = LocalizerMock ()
40- var batteryMonitor: BatteryMonitor = BatteryMonitorMock ( )
31+ var batteryMonitor: BatteryMonitor = BatteryMonitor ( MockHardware () )
4132
4233 // GoBilda starter bot specific components
43- var flywheel: Flywheel = FlywheelMock ( )
44- var launchServos: LaunchServos = LaunchServosMock ( )
34+ var flywheel: Flywheel = Flywheel ( MockHardware () )
35+ var launchServos: LaunchServos = LaunchServos ( MockHardware () )
4536
4637 // Other hardware components
47- var aprilTagProcessor: AprilTagProcessor = AprilTagMock ().processor
48- var camera: Camera = CameraMock ( )
38+ var aprilTagProcessor: AprilTagProcessor = AprilTag ().processor
39+ var camera: Camera = Camera ( MockHardware () )
4940
5041 // Path follower
5142 var follower = Follower (this )
@@ -54,8 +45,8 @@ class Bot(
5445 when (botType) {
5546 BotType .BASIC_MECANUM_BOT -> {
5647 // Initialize hardware components for Basic Mecanum Bot
57- mecanumBase = MecanumBaseImpl (hardwareMap, Constants . Drive . MOTOR_CONFIG )
58- batteryMonitor = BatteryMonitorImpl (hardwareMap)
48+ mecanumBase = MecanumBase (hardwareMap)
49+ batteryMonitor = BatteryMonitor (hardwareMap)
5950 }
6051
6152 BotType .MECANUM_BOT -> {
@@ -67,19 +58,19 @@ class Bot(
6758
6859 BotType .GOBILDA_STARTER_BOT -> {
6960 // Initialize hardware components for GoBilda Starter Bot
70- mecanumBase = MecanumBaseImpl (hardwareMap, Constants . Drive . MOTOR_CONFIG )
61+ mecanumBase = MecanumBase (hardwareMap)
7162 localizer = Pinpoint (hardwareMap)
72- batteryMonitor = BatteryMonitorImpl (hardwareMap)
73- flywheel = FlywheelImpl (hardwareMap)
74- launchServos = LaunchServosImpl (hardwareMap)
75- aprilTagProcessor = AprilTagImpl (
76- Constants .Camera .POSITION_CM ,
77- Constants .Camera .ORIENTATION_RAD
78- ).processor
63+ batteryMonitor = BatteryMonitor (hardwareMap)
64+ flywheel = Flywheel (hardwareMap)
65+ launchServos = LaunchServos (hardwareMap)
66+ aprilTagProcessor =
67+ AprilTag (
68+ CameraConstants .POSITION_CM ,
69+ CameraConstants .ORIENTATION_RAD ,
70+ ).processor
7971 camera =
80- CameraImpl (
72+ Camera (
8173 hardwareMap,
82- Constants .HardwareNames .WEBCAM ,
8374 processors = arrayOf(aprilTagProcessor),
8475 )
8576 }
0 commit comments