Update RobotTemplate

Changed the way of getting direction from the controller directly to specific axis. Not 100% sure on the tan because FRC removed the arc tangent EVEN THOUGH ORACLE RELEASED JAVADOCS ON IT.. so I did the inverse of the fraction and just tan!