Split up menu function to individual functions, changed if else tree to switch statement.
Split up menu function to individual functions, changed if else tree to switch statement.

madcowswe/ODrive,madcowswe/ODrive,madcowswe/ODriveFirmware,madcowswe/ODriveFirmware,madcowswe/ODrive,madcowswe/ODrive,madcowswe/ODrive,madcowswe/ODriveFirmware,madcowswe/ODriveFirmware