IPAB Neuromorphic / Koala
Committer:
IPAB
Date:
Thu Jul 15 23:51:56 2010 +0000
Revision:
3:c32adf6f5ec6
Parent:
2:b614b7a16e8d

        

Who changed what in which revision?

UserRevisionLine numberNew contents of line
IPAB 0:5d64dc944fa6 1 #include "Koala.h"
IPAB 0:5d64dc944fa6 2
IPAB 3:c32adf6f5ec6 3 Koala::Koala(PinName tx, PinName rx, int baudrate) : Serial(tx, rx) {
IPAB 0:5d64dc944fa6 4
IPAB 3:c32adf6f5ec6 5 this->baud(baudrate);
IPAB 3:c32adf6f5ec6 6 this->format(8,Serial::None,1);
IPAB 0:5d64dc944fa6 7 set_speed(0,0);
IPAB 0:5d64dc944fa6 8 set_pos_cnt(0,0);
IPAB 0:5d64dc944fa6 9 }
IPAB 0:5d64dc944fa6 10
IPAB 0:5d64dc944fa6 11
IPAB 1:0006a3271fa2 12 void Koala::dummyread() {
IPAB 0:5d64dc944fa6 13
IPAB 3:c32adf6f5ec6 14 char dummy = this->getc();
IPAB 0:5d64dc944fa6 15 }
IPAB 0:5d64dc944fa6 16
IPAB 0:5d64dc944fa6 17 char Koala::set_speed(int speedL,int speedR) {
IPAB 0:5d64dc944fa6 18
IPAB 3:c32adf6f5ec6 19 this->printf("D,%d,%d\n",speedL,speedR);
IPAB 3:c32adf6f5ec6 20 char reply = this->getc();
IPAB 0:5d64dc944fa6 21 dummyread();
IPAB 0:5d64dc944fa6 22 dummyread();
IPAB 0:5d64dc944fa6 23 return reply;
IPAB 0:5d64dc944fa6 24 }
IPAB 0:5d64dc944fa6 25
IPAB 0:5d64dc944fa6 26
IPAB 0:5d64dc944fa6 27 char Koala::set_pos_cnt(int posL,int posR) {
IPAB 0:5d64dc944fa6 28
IPAB 3:c32adf6f5ec6 29 this->printf("G,%d,%d\n",posL,posR);
IPAB 3:c32adf6f5ec6 30 char reply = this->getc();
IPAB 0:5d64dc944fa6 31 dummyread();
IPAB 0:5d64dc944fa6 32 dummyread();
IPAB 0:5d64dc944fa6 33 return reply;
IPAB 0:5d64dc944fa6 34 }
IPAB 0:5d64dc944fa6 35
IPAB 0:5d64dc944fa6 36 void Koala::read_position(int* nPosL, int* nPosR) {
IPAB 0:5d64dc944fa6 37
IPAB 0:5d64dc944fa6 38 int * PosL, * PosR;
IPAB 0:5d64dc944fa6 39 PosL = (int*)nPosL;
IPAB 0:5d64dc944fa6 40 PosR = (int*)nPosR;
IPAB 0:5d64dc944fa6 41
IPAB 3:c32adf6f5ec6 42 this->printf("H\n");
IPAB 3:c32adf6f5ec6 43 this->scanf("h,%d,%d",PosL,PosR);
IPAB 0:5d64dc944fa6 44 dummyread();
IPAB 0:5d64dc944fa6 45 dummyread();
IPAB 0:5d64dc944fa6 46 }
IPAB 0:5d64dc944fa6 47
IPAB 0:5d64dc944fa6 48 int Koala::read_channel(int channel) {
IPAB 0:5d64dc944fa6 49
IPAB 0:5d64dc944fa6 50 int reply;
IPAB 3:c32adf6f5ec6 51 this->printf("I,%d\n",channel);
IPAB 3:c32adf6f5ec6 52 this->scanf("i,%d",&reply);
IPAB 0:5d64dc944fa6 53 dummyread();
IPAB 0:5d64dc944fa6 54 dummyread();
IPAB 0:5d64dc944fa6 55 return reply;
IPAB 1:0006a3271fa2 56 }