using switch case in main loop, fixing move fucntions
finished switch case. Adding all pins