M Seiser / Serial_HL

Fork of Serial_HL by michael hollegha

Committer:
hollegha2
Date:
Fri Apr 25 18:23:25 2014 +0000
Revision:
0:b958bdf108cf
Child:
1:1a03b6d5226f
Serial_HL

Who changed what in which revision?

UserRevisionLine numberNew contents of line
hollegha2 0:b958bdf108cf 1
hollegha2 0:b958bdf108cf 2 #include "Serial_HL.h"
hollegha2 0:b958bdf108cf 3 #include <stdarg.h>
hollegha2 0:b958bdf108cf 4 #include <stdio.h>
hollegha2 0:b958bdf108cf 5
hollegha2 0:b958bdf108cf 6 namespace mbed {
hollegha2 0:b958bdf108cf 7
hollegha2 0:b958bdf108cf 8 SerialBLK::SerialBLK(PinName tx, PinName rx) {
hollegha2 0:b958bdf108cf 9 serial_init(&_serial, tx, rx);
hollegha2 0:b958bdf108cf 10 _baud = 9600;
hollegha2 0:b958bdf108cf 11 serial_irq_handler(&_serial, SerialBLK::_irq_handler, (uint32_t)this);
hollegha2 0:b958bdf108cf 12 }
hollegha2 0:b958bdf108cf 13
hollegha2 0:b958bdf108cf 14 void SerialBLK::baud(int baudrate) {
hollegha2 0:b958bdf108cf 15 serial_baud(&_serial, baudrate);
hollegha2 0:b958bdf108cf 16 _baud = baudrate;
hollegha2 0:b958bdf108cf 17 }
hollegha2 0:b958bdf108cf 18
hollegha2 0:b958bdf108cf 19 void SerialBLK::format(int bits, Parity parity, int stop_bits) {
hollegha2 0:b958bdf108cf 20 serial_format(&_serial, bits, (SerialParity)parity, stop_bits);
hollegha2 0:b958bdf108cf 21 }
hollegha2 0:b958bdf108cf 22
hollegha2 0:b958bdf108cf 23 int SerialBLK::readable() {
hollegha2 0:b958bdf108cf 24 return serial_readable(&_serial);
hollegha2 0:b958bdf108cf 25 }
hollegha2 0:b958bdf108cf 26
hollegha2 0:b958bdf108cf 27 int SerialBLK::writeable() {
hollegha2 0:b958bdf108cf 28 return serial_writable(&_serial);
hollegha2 0:b958bdf108cf 29 }
hollegha2 0:b958bdf108cf 30
hollegha2 0:b958bdf108cf 31 void SerialBLK::attach(void (*fptr)(void), IrqType type) {
hollegha2 0:b958bdf108cf 32 if (fptr) {
hollegha2 0:b958bdf108cf 33 _irq[type].attach(fptr);
hollegha2 0:b958bdf108cf 34 serial_irq_set(&_serial, (SerialIrq)type, 1);
hollegha2 0:b958bdf108cf 35 } else {
hollegha2 0:b958bdf108cf 36 serial_irq_set(&_serial, (SerialIrq)type, 0);
hollegha2 0:b958bdf108cf 37 }
hollegha2 0:b958bdf108cf 38 }
hollegha2 0:b958bdf108cf 39
hollegha2 0:b958bdf108cf 40 void SerialBLK::_irq_handler(uint32_t id, SerialIrq irq_type) {
hollegha2 0:b958bdf108cf 41 SerialBLK *obj = (SerialBLK*)id;
hollegha2 0:b958bdf108cf 42 obj->_irq[irq_type].call();
hollegha2 0:b958bdf108cf 43 }
hollegha2 0:b958bdf108cf 44
hollegha2 0:b958bdf108cf 45 int SerialBLK::GetChar() {
hollegha2 0:b958bdf108cf 46 return serial_getc(&_serial);
hollegha2 0:b958bdf108cf 47 }
hollegha2 0:b958bdf108cf 48
hollegha2 0:b958bdf108cf 49 void SerialBLK::PutChar(int aCh) {
hollegha2 0:b958bdf108cf 50 serial_putc(&_serial, aCh);
hollegha2 0:b958bdf108cf 51 }
hollegha2 0:b958bdf108cf 52
hollegha2 0:b958bdf108cf 53 void SerialBLK::Write(void* aData, uint32_t aLenBytes)
hollegha2 0:b958bdf108cf 54 {
hollegha2 0:b958bdf108cf 55 uint8_t* ptr = (uint8_t*)aData;
hollegha2 0:b958bdf108cf 56 for(int i=0; i<aLenBytes; i++) {
hollegha2 0:b958bdf108cf 57 this->PutChar(*ptr); ptr++;
hollegha2 0:b958bdf108cf 58 }
hollegha2 0:b958bdf108cf 59 }
hollegha2 0:b958bdf108cf 60
hollegha2 0:b958bdf108cf 61 void SerialBLK::Read(void* aData, uint32_t aLenBytes)
hollegha2 0:b958bdf108cf 62 {
hollegha2 0:b958bdf108cf 63 uint8_t* ptr = (uint8_t*)aData;
hollegha2 0:b958bdf108cf 64 for(int i=0; i<aLenBytes; i++) {
hollegha2 0:b958bdf108cf 65 *ptr=this->GetChar(); ptr++;
hollegha2 0:b958bdf108cf 66 }
hollegha2 0:b958bdf108cf 67 }
hollegha2 0:b958bdf108cf 68
hollegha2 0:b958bdf108cf 69
hollegha2 0:b958bdf108cf 70
hollegha2 0:b958bdf108cf 71
hollegha2 0:b958bdf108cf 72 void SvProtocol::Puts(char* aCStr)
hollegha2 0:b958bdf108cf 73 {
hollegha2 0:b958bdf108cf 74 while( *aCStr != '\0' )
hollegha2 0:b958bdf108cf 75 {
hollegha2 0:b958bdf108cf 76 if( *aCStr=='\n' )
hollegha2 0:b958bdf108cf 77 _st->PutChar('\r');
hollegha2 0:b958bdf108cf 78 _st->PutChar(*aCStr);
hollegha2 0:b958bdf108cf 79 aCStr++;
hollegha2 0:b958bdf108cf 80 }
hollegha2 0:b958bdf108cf 81 _st->PutChar(0); // terminate with 0
hollegha2 0:b958bdf108cf 82 }
hollegha2 0:b958bdf108cf 83
hollegha2 0:b958bdf108cf 84 static char sBuffer[50];
hollegha2 0:b958bdf108cf 85
hollegha2 0:b958bdf108cf 86 void SvProtocol::Printf(const char *format, ...)
hollegha2 0:b958bdf108cf 87 {
hollegha2 0:b958bdf108cf 88 va_list vArgs;
hollegha2 0:b958bdf108cf 89 va_start(vArgs, format);
hollegha2 0:b958bdf108cf 90 vsprintf(sBuffer, (char const *)format, vArgs);
hollegha2 0:b958bdf108cf 91 va_end(vArgs);
hollegha2 0:b958bdf108cf 92 Puts(sBuffer);
hollegha2 0:b958bdf108cf 93 }
hollegha2 0:b958bdf108cf 94
hollegha2 0:b958bdf108cf 95 void SvProtocol::SvPrintf(const char *format, ...)
hollegha2 0:b958bdf108cf 96 {
hollegha2 0:b958bdf108cf 97 va_list vArgs;
hollegha2 0:b958bdf108cf 98 va_start(vArgs, format);
hollegha2 0:b958bdf108cf 99 vsprintf(sBuffer, (char const *)format, vArgs);
hollegha2 0:b958bdf108cf 100 va_end(vArgs);
hollegha2 0:b958bdf108cf 101 if( !svMessageON ) return;
hollegha2 0:b958bdf108cf 102 _st->PutChar(10);
hollegha2 0:b958bdf108cf 103 Puts(sBuffer);
hollegha2 0:b958bdf108cf 104 }
hollegha2 0:b958bdf108cf 105
hollegha2 0:b958bdf108cf 106 void SvProtocol::WriteSV3p13(int aId, float aData) {
hollegha2 0:b958bdf108cf 107 // int16_t val = To3p13(aData);
hollegha2 0:b958bdf108cf 108 // PutChar(aId); Write(&val,2);
hollegha2 0:b958bdf108cf 109 }
hollegha2 0:b958bdf108cf 110
hollegha2 0:b958bdf108cf 111 int SvProtocol::GetCommand()
hollegha2 0:b958bdf108cf 112 {
hollegha2 0:b958bdf108cf 113 uint8_t cmd = _st->GetChar();
hollegha2 0:b958bdf108cf 114 if( cmd==1 )
hollegha2 0:b958bdf108cf 115 {
hollegha2 0:b958bdf108cf 116 this->acqON = _st->GetChar();
hollegha2 0:b958bdf108cf 117 if( this->acqON )
hollegha2 0:b958bdf108cf 118 this->SvMessage("AcqON");
hollegha2 0:b958bdf108cf 119 else
hollegha2 0:b958bdf108cf 120 this->SvMessage("AcqOFF");
hollegha2 0:b958bdf108cf 121 return 0;
hollegha2 0:b958bdf108cf 122 }
hollegha2 0:b958bdf108cf 123 return cmd;
hollegha2 0:b958bdf108cf 124 }
hollegha2 0:b958bdf108cf 125
hollegha2 0:b958bdf108cf 126 } // namespace mbed
hollegha2 0:b958bdf108cf 127
hollegha2 0:b958bdf108cf 128
hollegha2 0:b958bdf108cf 129
hollegha2 0:b958bdf108cf 130