Initial commit of IR control and simple motor control