Interface to IR working

Got the interface to infernal robotics working, built the function to
command the robotics to a set point.