lol, forgot to include the code in main()
changed servo logic