/* * ServiceInterfaceBuffer.cpp * * Created on: 06.08.2015 * Author: baetz */ #include #include int ServiceInterfaceBuffer::overflow(int c) { // Handle output putChars(pbase(), pptr()); if (c != Traits::eof()) { char c2 = c; // Handle the one character that didn't fit to buffer putChars(&c2, &c2 + 1); } // This tells that buffer is empty again setp(buf, buf + BUF_SIZE - 1); // I'm not sure about this return value! return 0; } int ServiceInterfaceBuffer::sync(void) { if (this->isActive) { TimeOfDay_t loggerTime; OSAL::getDateAndTime(&loggerTime); char preamble[96] = { 0 }; sprintf(preamble, "%s: | %lu:%02lu:%02lu.%03lu | ", this->log_message.c_str(), (unsigned long) loggerTime.hour, (unsigned long) loggerTime.minute, (unsigned long) loggerTime.second, (unsigned long) loggerTime.ticks); // Write log_message and time this->putChars(preamble, preamble + sizeof(preamble)); // Handle output this->putChars(pbase(), pptr()); } // This tells that buffer is empty again setp(buf, buf + BUF_SIZE - 1); return 0; } #ifdef UT699 ServiceInterfaceBuffer::ServiceInterfaceBuffer(std::string set_message, uint16_t port) { this->log_message = set_message; this->isActive = true; setp( buf, buf + BUF_SIZE ); } void ServiceInterfaceBuffer::putChars(char const* begin, char const* end) { char array[BUF_SIZE]; uint32_t length = end - begin; if (length > sizeof(array)) { length = sizeof(array); } memcpy(array, begin, length); #ifdef DEBUG if (!OSAL::isInterruptInProgress()) { std::cout << array; } else { //Uncomment the following line if you need ISR debug output. // printk(array); } #else #error Non-DEBUG out messages are not implemented. define DEBUG flag! #endif } #endif //UT699 #ifdef ML505 #include ServiceInterfaceBuffer::ServiceInterfaceBuffer(std::string set_message, uint16_t port) : isActive(true), log_message(set_message), udpSocket(0), remoteAddressLength( sizeof(remoteAddress)) { setp(buf, buf + BUF_SIZE); memset((uint8_t*) &remoteAddress, 0, sizeof(remoteAddress)); remoteAddress.sin_family = AF_INET; remoteAddress.sin_port = htons(port); remoteAddress.sin_addr.s_addr = htonl(inet_addr("192.168.250.100")); } void ServiceInterfaceBuffer::putChars(char const* begin, char const* end) { char array[BUF_SIZE]; uint32_t length = end - begin; if (length > sizeof(array)) { length = sizeof(array); } memcpy(array, begin, length); if (udpSocket <= 0) { initSocket(); } #ifdef DEBUG if (udpSocket > 0) { sendto(udpSocket, array, length, 0, (sockaddr*) &remoteAddress, sizeof(remoteAddress)); } #else #error Non-DEBUG out messages are not implemented. define DEBUG flag! #endif } void ServiceInterfaceBuffer::initSocket() { sockaddr_in address; memset((uint8_t*) &address, 0, sizeof(address)); address.sin_family = AF_INET; address.sin_port = htons(0); address.sin_addr.s_addr = htonl(INADDR_ANY); udpSocket = socket(PF_INET, SOCK_DGRAM, 0); if (socket < 0) { printf("Error opening socket!\n"); return; } timeval timeout = { 0, 20 }; if (setsockopt(udpSocket, SOL_SOCKET, SO_RCVTIMEO, &timeout, sizeof(timeout)) < 0) { printf("Error setting SO_RCVTIMEO socket options!\n"); return; } if (setsockopt(udpSocket, SOL_SOCKET, SO_SNDTIMEO, &timeout, sizeof(timeout)) < 0) { printf("Error setting SO_SNDTIMEO socket options!\n"); return; } if (bind(udpSocket, (sockaddr *) &address, sizeof(address)) < 0) { printf("Error binding socket!\n"); } } #endif //ML505