daad

Dependencies:   mbed TrapezoidControl QEI

Communication/Controller/Mu/Mu.cpp

Committer:
yabahiro
Date:
2019-09-17
Revision:
25:38d4964e8aad
Parent:
1:b1219d8ca117

File content as of revision 25:38d4964e8aad:

#include "Mu.h"
#include "mbed.h"

namespace MU {
	Serial MuUart(MU_TX, MU_RX);

    namespace {
		char Group[][4]		= {"01", "02", "03", "04"};
		char Channel[][4]	= {"08", "14", "1F", "2E"};
		char DI[][4]		= {"10", "20", "40", "80"};
		char EI[][4]		= {"01", "02", "04", "08"};
    }

	void Mu::SendCommand(char *command, char *value, uint8_t valueLength) {
        MuUart.putc('@');
        MuUart.putc(command[0]);
        MuUart.putc(command[1]);
        while(valueLength--) {
            MuUart.putc(*value);
            value++;
        }
        MuUart.putc('\r');
        MuUart.putc('\n');
    }

    void Mu::Initialize(uint8_t select) {
        MuUart.baud(19200);

		Mu::SendCommand("GI",Group[select],2);
		Mu::SendCommand("CH",Channel[select],2);
		Mu::SendCommand("DI",DI[select],2);
		Mu::SendCommand("EI",EI[select],2);
    }
}