Legibility and Accel deletion

With the accelerometers disabled, all the code was doing was cluttering the already large file.

We can always refer to the older ones when needed if re-introducing the accelerometer to do INS.

Currently working on clarifying and improving the command parsing/reading to optimize data usage and facilitate further commands.