Simple teleop

Add SimpleTeleop.c