some code. finally.
Merged
Made it build. please dont come back teleop.cpp. thanks.