File content as of revision 4:b4c8d6671241:

#include "mbed.h"
#include "math.h"
#include "krs.h"
AnalogIn fsr(PC_0);
Serial pc(USBTX,USBRX);
//krs master(PA_9,PA_10,PC_7,1250000);
krs master(PA_9,PA_10,PC_7,112500);
int main() {
    pc.printf("hello\r\n");
    
    int deg=0;
    char degpart[3];
    int id;
    char a;
    while(1){
    pc.printf("choose1 or 2 or3\r\n");
    a=pc.getc();
    switch(a){
    case '1':
    pc.printf("degree\r\n");
    for(int i=0;i<3;i++){
        degpart[i]=pc.getc()-48;
        printf("%d",degpart[i]);      
        }
        printf("\r\n");
        deg=100*degpart[0]+10*degpart[1]+degpart[2];
    
    pc.printf("%d\r\n",deg);
    pc.printf("id\r\n");
    id=pc.getc()-48;
    
    pc.printf("%d\r\n",id);
    master.setpos(deg,id);
    //getID();
    wait(0.3);
    master.getpos(id);
    break;
    
    
    case '2':
    double i;
    i=fsr.read();
    
    deg=i*270-135;
    pc.printf("%d\r\n",deg);
    master.setpos(deg,5);
    break;
    
    case '3':
    pc.printf("id\r\n");
    id=pc.getc()-48;
    
    pc.printf("%d\r\n",id);
    master.getpos(id);
    break;
    
    case '4':
    pc.printf("w\r\n");
    while(1){
    master.setpos(90,5);
    
    master.setpos(135,6);
    wait(0.4);
    master.setpos(0,5);
    
    master.setpos(0,6);
    wait(0.4);
    }
    break;
    
    default:
    break;
    }
   }  
}