wpimath Package

wpimath functions