here is a basic robot from home to start position code will add rest when robot is built and i can get the right angels for the start and home position