gggggg

main.cpp

Committer:
yusuke_robocup
Date:
2013-03-04
Revision:
0:521d2ffbfecf

File content as of revision 0:521d2ffbfecf:

#include "mbed.h"

DigitalOut myled(LED1);

int main() {
    while(1) {
        myled = 1;
        wait(0.2);
        myled = 0;
        wait(0.2);
    }
}

#include <Wire.h>
#include <SoftwareSerial.h>

SoftwareSerial hexmot(4,5); //rx:4 tx:5

void setup()
{
  Serial.begin(9600);
  hexmot.begin(19200);
}

void loop()
{
  serialhexmot(100,-100,0,50,-50,1);
  delay(500);
}

void serialhexmot(int a,int b,int c,int d,int e,int f)
{
  int z = 0;
  int input[6] = {a,b,c,d,e,f};
  int output[6] = {0,0,0,0,0,0};
  int val = 0;
  String StringA = 0;
  String StringB = 0;
  String StringC = 0;
  String StringD = 0;
  String StringE = 0;
  String StringF = 0;
  String StringX = 0;
  String StringY = 0;
  String StringZ = 0;
  String String0 = 0;
  
    StringX = String(1);
    val = input[0];//*100/255;
    if(val < 0 && val >= -100)
    {
      StringY = String('R');
      val = abs(val);
      StringZ = String(val);
    }
    else if(val >= 0 && val <= 100)
    {
      StringY = String('F');
      StringZ = String(val);
    }
    else
    {
      StringY = String('F');
      StringZ = String(0);
    }
    if(val < 10)
    {
      String0 = String("00");
      StringZ = String0 + StringZ;
    }
    else if(val < 100)
    {
      String0 = String('0');
      StringZ = String0 + StringZ;
    }
    else
    {
      String0 = String("");
    }
    StringA = StringX + StringY + StringZ;
    
    
    StringX = String(2);
    val = input[1];//*100/255;
    if(val < 0 && val >= -100)
    {
      StringY = String('R');
      val = abs(val);
      StringZ = String(val);
    }
    else if(val >= 0 && val <= 100)
    {
      StringY = String('F');
      StringZ = String(val);
    }
    else
    {
      StringY = String('F');
      StringZ = String(0);
    }
    if(val < 10)
    {
      String0 = String("00");
      StringZ = String0 + StringZ;
    }
    else if(val < 100)
    {
      String0 = String('0');
      StringZ = String0 + StringZ;
    }
    else
    {
    }
    StringB = StringX + StringY + StringZ;
    
    
    StringX = String(3);
    val = input[2];//*100/255;
    if(val < 0 && val >= -100)
    {
      StringY = String('R');
      val = abs(val);
      StringZ = String(val);
    }
    else if(val >= 0 && val <= 100)
    {
      StringY = String('F');
      StringZ = String(val);
    }
    else
    {
      StringY = String('F');
      StringZ = String(0);
    }
    if(val < 10)
    {
      String0 = String("00");
      StringZ = String0 + StringZ;
    }
    else if(val < 100)
    {
      String0 = String('0');
      StringZ = String0 + StringZ;
    }
    else
    {
    }
    StringC = StringX + StringY + StringZ;
    
    
    StringX = String(4);
    val = input[3];//*100/255;
    if(val < 0 && val >= -100)
    {
      StringY = String('R');
      val = abs(val);
      StringZ = String(val);
    }
    else if(val >= 0 && val <= 100)
    {
      StringY = String('F');
      StringZ = String(val);
    }
    else
    {
      StringY = String('F');
      StringZ = String(0);
    }
    if(val < 10)
    {
      String0 = String("00");
      StringZ = String0 + StringZ;
    }
    else if(val < 100)
    {
      String0 = String('0');
      StringZ = String0 + StringZ;
    }
    else
    {
    }
    StringD = StringX + StringY + StringZ;
    
    
    StringX = String(5);
    val = input[4];//*100/255;
    if(val < 0 && val >= -100)
    {
      StringY = String('R');
      val = abs(val);
      StringZ = String(val);
    }
    else if(val >= 0 && val <= 100)
    {
      StringY = String('F');
      StringZ = String(val);
    }
    else
    {
      StringY = String('F');
      StringZ = String(0);
    }
    if(val < 10)
    {
      String0 = String("00");
      StringZ = String0 + StringZ;
    }
    else if(val < 100)
    {
      String0 = String('0');
      StringZ = String0 + StringZ;
    }
    else
    {
    }
    StringE = StringX + StringY + StringZ;
    
    
    StringX = String(6);
    val = input[5];//*100/255;
    if(val < 0 && val >= -100)
    {
      StringY = String('R');
      val = abs(val);
      StringZ = String(val);
    }
    else if(val >= 0 && val <= 100)
    {
      StringY = String('F');
      StringZ = String(val);
    }
    else
    {
      StringY = String('F');
      StringZ = String(0);
    }
    if(val < 10)
    {
      String0 = String("00");
      StringZ = String0 + StringZ;
    }
    else if(val < 100)
    {
      String0 = String('0');
      StringZ = String0 + StringZ;
    }
    else
    {
    }
    StringF = StringX + StringY + StringZ;
    
    Serial.println(StringA+StringB+StringC+StringD+StringE+StringF);  
    hexmot.println(StringA+StringB+StringC+StringD+StringE+StringF);
}