Robot Library using MSP340 interface