started MCS.cpp

This commit is contained in:
ROS Station
2019-12-05 14:56:49 +01:00
parent 416084d674
commit a8b1f9d20f

View File

@@ -66,11 +66,26 @@ int openSerialPort() {
int main()
{
//INITIALIZATION
// * Get Serial Port ready
int fd = 0;
fd=openSerialPort();
char full_cmd [1000];
// add ':' before and '\n' after cmd (SmarAct Command Syntax)
//MAIN LOOP
// * Check for high priority: have values changed.
// Execute these first.
// * If there's nothing in the priority queue, execute get status
// Usally do these things during a loop:
//
//sprintf(full_cmd, ":GSI\n:GNC\n:FRM0,1,1,0\n");
sprintf(full_cmd, ":GSI\n:GIV\n:GNC\n:GCT0\n:GCT1\n:GCT2\n:GCT3\n:GCT4\n:GCT5\n:SHE1\n:SCM1\n");
//fcntl(fd, F_SETFL, 0); // 0 blocks the system while reading serial port