teleop fnished. need electronical tweaking.