Fixed up mislabed cmd handlers, erros in ParseBearings that stopped it from working