git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/CORTEX_A9_Zynq_ZC702/RTOSDemo_bsp/ps7_cortexa9_0/libsrc/standalone_v6_6/src/write.c

   1 /******************************************************************************
   2 *
   3 * Copyright (C) 2009 - 2018 Xilinx, Inc.  All rights reserved.
   4 *
   5 * Permission is hereby granted, free of charge, to any person obtaining a copy
   6 * of this software and associated documentation files (the "Software"), to deal
   7 * in the Software without restriction, including without limitation the rights
   8 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
   9 * copies of the Software, and to permit persons to whom the Software is
  10 * furnished to do so, subject to the following conditions:
  11 *
  12 * The above copyright notice and this permission notice shall be included in
  13 * all copies or substantial portions of the Software.
  14 *
  15 * Use of the Software is limited solely to applications:
  16 * (a) running on a Xilinx device, or
  17 * (b) that interact with a Xilinx device through a bus or interconnect.
  18 *
  19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  20 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  21 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  22 * XILINX  BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
  23 * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF
  24 * OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  25 * SOFTWARE.
  26 *
  27 * Except as contained in this notice, the name of the Xilinx shall not be used
  28 * in advertising or otherwise to promote the sale, use or other dealings in
  29 * this Software without prior written authorization from Xilinx.
  30 *
  31 ******************************************************************************/
  32
  33 /* write.c -- write bytes to an output device.
  34  */
  35 #ifndef UNDEFINE_FILE_OPS
  36 #include "xil_printf.h"
  37 #include "xparameters.h"
  38
  39 #ifdef __cplusplus
  40 extern "C" {
  41         __attribute__((weak)) sint32 _write (sint32 fd, char8* buf, sint32 nbytes);
  42 }
  43 #endif
  44
  45 /*
  46  * write -- write bytes to the serial port. Ignore fd, since
  47  *          stdout and stderr are the same. Since we have no filesystem,
  48  *          open will only return an error.
  49  */
  50 __attribute__((weak)) sint32
  51 write (sint32 fd, char8* buf, sint32 nbytes)
  52
  53 {
  54 #ifdef STDOUT_BASEADDRESS
  55   s32 i;
  56   char8* LocalBuf = buf;
  57
  58   (void)fd;
  59   for (i = 0; i < nbytes; i++) {
  60         if(LocalBuf != NULL) {
  61                 LocalBuf += i;
  62         }
  63         if(LocalBuf != NULL) {
  64             if (*LocalBuf == '\n') {
  65               outbyte ('\r');
  66             }
  67             outbyte (*LocalBuf);
  68         }
  69         if(LocalBuf != NULL) {
  70                 LocalBuf -= i;
  71         }
  72   }
  73   return (nbytes);
  74 #else
  75   (void)fd;
  76   (void)buf;
  77   (void)nbytes;
  78   return 0;
  79 #endif
  80 }
  81
  82 __attribute__((weak)) sint32
  83 _write (sint32 fd, char8* buf, sint32 nbytes)
  84 {
  85 #if HYP_GUEST && EL1_NONSECURE && XEN_USE_PV_CONSOLE
  86         sint32 length;
  87
  88         (void)fd;
  89         (void)nbytes;
  90         length = XPVXenConsole_Write(buf);
  91         return length;
  92 #else
  93 #ifdef STDOUT_BASEADDRESS
  94   s32 i;
  95   char8* LocalBuf = buf;
  96
  97   (void)fd;
  98   for (i = 0; i < nbytes; i++) {
  99         if(LocalBuf != NULL) {
 100                 LocalBuf += i;
 101         }
 102         if(LocalBuf != NULL) {
 103             if (*LocalBuf == '\n') {
 104               outbyte ('\r');
 105             }
 106             outbyte (*LocalBuf);
 107         }
 108         if(LocalBuf != NULL) {
 109                 LocalBuf -= i;
 110         }
 111   }
 112   return (nbytes);
 113 #else
 114   (void)fd;
 115   (void)buf;
 116   (void)nbytes;
 117   return 0;
 118 #endif
 119 #endif
 120 }
 121 #endif