| /***************************************************************************** |
| * |
| * Author: Xilinx, Inc. |
| * |
| * This program is free software; you can redistribute it and/or modify it |
| * under the terms of the GNU General Public License as published by the |
| * Free Software Foundation; either version 2 of the License, or (at your |
| * option) any later version. |
| * |
| * XILINX IS PROVIDING THIS DESIGN, CODE, OR INFORMATION "AS IS" |
| * AS A COURTESY TO YOU, SOLELY FOR USE IN DEVELOPING PROGRAMS AND |
| * SOLUTIONS FOR XILINX DEVICES. BY PROVIDING THIS DESIGN, CODE, |
| * OR INFORMATION AS ONE POSSIBLE IMPLEMENTATION OF THIS FEATURE, |
| * APPLICATION OR STANDARD, XILINX IS MAKING NO REPRESENTATION |
| * THAT THIS IMPLEMENTATION IS FREE FROM ANY CLAIMS OF INFRINGEMENT, |
| * AND YOU ARE RESPONSIBLE FOR OBTAINING ANY RIGHTS YOU MAY REQUIRE |
| * FOR YOUR IMPLEMENTATION. XILINX EXPRESSLY DISCLAIMS ANY |
| * WARRANTY WHATSOEVER WITH RESPECT TO THE ADEQUACY OF THE |
| * IMPLEMENTATION, INCLUDING BUT NOT LIMITED TO ANY WARRANTIES OR |
| * REPRESENTATIONS THAT THIS IMPLEMENTATION IS FREE FROM CLAIMS OF |
| * INFRINGEMENT, IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS |
| * FOR A PARTICULAR PURPOSE. |
| * |
| * (c) Copyright 2003-2008 Xilinx Inc. |
| * All rights reserved. |
| * |
| * You should have received a copy of the GNU General Public License along |
| * with this program; if not, write to the Free Software Foundation, Inc., |
| * 675 Mass Ave, Cambridge, MA 02139, USA. |
| * |
| *****************************************************************************/ |
| |
| #include "buffer_icap.h" |
| |
| /* Indicates how many bytes will fit in a buffer. (1 BRAM) */ |
| #define XHI_MAX_BUFFER_BYTES 2048 |
| #define XHI_MAX_BUFFER_INTS (XHI_MAX_BUFFER_BYTES >> 2) |
| |
| /* File access and error constants */ |
| #define XHI_DEVICE_READ_ERROR -1 |
| #define XHI_DEVICE_WRITE_ERROR -2 |
| #define XHI_BUFFER_OVERFLOW_ERROR -3 |
| |
| #define XHI_DEVICE_READ 0x1 |
| #define XHI_DEVICE_WRITE 0x0 |
| |
| /* Constants for checking transfer status */ |
| #define XHI_CYCLE_DONE 0 |
| #define XHI_CYCLE_EXECUTING 1 |
| |
| /* buffer_icap register offsets */ |
| |
| /* Size of transfer, read & write */ |
| #define XHI_SIZE_REG_OFFSET 0x800L |
| /* offset into bram, read & write */ |
| #define XHI_BRAM_OFFSET_REG_OFFSET 0x804L |
| /* Read not Configure, direction of transfer. Write only */ |
| #define XHI_RNC_REG_OFFSET 0x808L |
| /* Indicates transfer complete. Read only */ |
| #define XHI_STATUS_REG_OFFSET 0x80CL |
| |
| /* Constants for setting the RNC register */ |
| #define XHI_CONFIGURE 0x0UL |
| #define XHI_READBACK 0x1UL |
| |
| /* Constants for the Done register */ |
| #define XHI_NOT_FINISHED 0x0UL |
| #define XHI_FINISHED 0x1UL |
| |
| #define XHI_BUFFER_START 0 |
| |
| /** |
| * buffer_icap_get_status - Get the contents of the status register. |
| * @drvdata: a pointer to the drvdata. |
| * |
| * The status register contains the ICAP status and the done bit. |
| * |
| * D8 - cfgerr |
| * D7 - dalign |
| * D6 - rip |
| * D5 - in_abort_l |
| * D4 - Always 1 |
| * D3 - Always 1 |
| * D2 - Always 1 |
| * D1 - Always 1 |
| * D0 - Done bit |
| **/ |
| u32 buffer_icap_get_status(struct hwicap_drvdata *drvdata) |
| { |
| return in_be32(drvdata->base_address + XHI_STATUS_REG_OFFSET); |
| } |
| |
| /** |
| * buffer_icap_get_bram - Reads data from the storage buffer bram. |
| * @base_address: contains the base address of the component. |
| * @offset: The word offset from which the data should be read. |
| * |
| * A bram is used as a configuration memory cache. One frame of data can |
| * be stored in this "storage buffer". |
| **/ |
| static inline u32 buffer_icap_get_bram(void __iomem *base_address, |
| u32 offset) |
| { |
| return in_be32(base_address + (offset << 2)); |
| } |
| |
| /** |
| * buffer_icap_busy - Return true if the icap device is busy |
| * @base_address: is the base address of the device |
| * |
| * The queries the low order bit of the status register, which |
| * indicates whether the current configuration or readback operation |
| * has completed. |
| **/ |
| static inline bool buffer_icap_busy(void __iomem *base_address) |
| { |
| u32 status = in_be32(base_address + XHI_STATUS_REG_OFFSET); |
| return (status & 1) == XHI_NOT_FINISHED; |
| } |
| |
| /** |
| * buffer_icap_set_size - Set the size register. |
| * @base_address: is the base address of the device |
| * @data: The size in bytes. |
| * |
| * The size register holds the number of 8 bit bytes to transfer between |
| * bram and the icap (or icap to bram). |
| **/ |
| static inline void buffer_icap_set_size(void __iomem *base_address, |
| u32 data) |
| { |
| out_be32(base_address + XHI_SIZE_REG_OFFSET, data); |
| } |
| |
| /** |
| * buffer_icap_set_offset - Set the bram offset register. |
| * @base_address: contains the base address of the device. |
| * @data: is the value to be written to the data register. |
| * |
| * The bram offset register holds the starting bram address to transfer |
| * data from during configuration or write data to during readback. |
| **/ |
| static inline void buffer_icap_set_offset(void __iomem *base_address, |
| u32 data) |
| { |
| out_be32(base_address + XHI_BRAM_OFFSET_REG_OFFSET, data); |
| } |
| |
| /** |
| * buffer_icap_set_rnc - Set the RNC (Readback not Configure) register. |
| * @base_address: contains the base address of the device. |
| * @data: is the value to be written to the data register. |
| * |
| * The RNC register determines the direction of the data transfer. It |
| * controls whether a configuration or readback take place. Writing to |
| * this register initiates the transfer. A value of 1 initiates a |
| * readback while writing a value of 0 initiates a configuration. |
| **/ |
| static inline void buffer_icap_set_rnc(void __iomem *base_address, |
| u32 data) |
| { |
| out_be32(base_address + XHI_RNC_REG_OFFSET, data); |
| } |
| |
| /** |
| * buffer_icap_set_bram - Write data to the storage buffer bram. |
| * @base_address: contains the base address of the component. |
| * @offset: The word offset at which the data should be written. |
| * @data: The value to be written to the bram offset. |
| * |
| * A bram is used as a configuration memory cache. One frame of data can |
| * be stored in this "storage buffer". |
| **/ |
| static inline void buffer_icap_set_bram(void __iomem *base_address, |
| u32 offset, u32 data) |
| { |
| out_be32(base_address + (offset << 2), data); |
| } |
| |
| /** |
| * buffer_icap_device_read - Transfer bytes from ICAP to the storage buffer. |
| * @drvdata: a pointer to the drvdata. |
| * @offset: The storage buffer start address. |
| * @count: The number of words (32 bit) to read from the |
| * device (ICAP). |
| **/ |
| static int buffer_icap_device_read(struct hwicap_drvdata *drvdata, |
| u32 offset, u32 count) |
| { |
| |
| s32 retries = 0; |
| void __iomem *base_address = drvdata->base_address; |
| |
| if (buffer_icap_busy(base_address)) |
| return -EBUSY; |
| |
| if ((offset + count) > XHI_MAX_BUFFER_INTS) |
| return -EINVAL; |
| |
| /* setSize count*4 to get bytes. */ |
| buffer_icap_set_size(base_address, (count << 2)); |
| buffer_icap_set_offset(base_address, offset); |
| buffer_icap_set_rnc(base_address, XHI_READBACK); |
| |
| while (buffer_icap_busy(base_address)) { |
| retries++; |
| if (retries > XHI_MAX_RETRIES) |
| return -EBUSY; |
| } |
| return 0; |
| |
| }; |
| |
| /** |
| * buffer_icap_device_write - Transfer bytes from ICAP to the storage buffer. |
| * @drvdata: a pointer to the drvdata. |
| * @offset: The storage buffer start address. |
| * @count: The number of words (32 bit) to read from the |
| * device (ICAP). |
| **/ |
| static int buffer_icap_device_write(struct hwicap_drvdata *drvdata, |
| u32 offset, u32 count) |
| { |
| |
| s32 retries = 0; |
| void __iomem *base_address = drvdata->base_address; |
| |
| if (buffer_icap_busy(base_address)) |
| return -EBUSY; |
| |
| if ((offset + count) > XHI_MAX_BUFFER_INTS) |
| return -EINVAL; |
| |
| /* setSize count*4 to get bytes. */ |
| buffer_icap_set_size(base_address, count << 2); |
| buffer_icap_set_offset(base_address, offset); |
| buffer_icap_set_rnc(base_address, XHI_CONFIGURE); |
| |
| while (buffer_icap_busy(base_address)) { |
| retries++; |
| if (retries > XHI_MAX_RETRIES) |
| return -EBUSY; |
| } |
| return 0; |
| |
| }; |
| |
| /** |
| * buffer_icap_reset - Reset the logic of the icap device. |
| * @drvdata: a pointer to the drvdata. |
| * |
| * Writing to the status register resets the ICAP logic in an internal |
| * version of the core. For the version of the core published in EDK, |
| * this is a noop. |
| **/ |
| void buffer_icap_reset(struct hwicap_drvdata *drvdata) |
| { |
| out_be32(drvdata->base_address + XHI_STATUS_REG_OFFSET, 0xFEFE); |
| } |
| |
| /** |
| * buffer_icap_set_configuration - Load a partial bitstream from system memory. |
| * @drvdata: a pointer to the drvdata. |
| * @data: Kernel address of the partial bitstream. |
| * @size: the size of the partial bitstream in 32 bit words. |
| **/ |
| int buffer_icap_set_configuration(struct hwicap_drvdata *drvdata, u32 *data, |
| u32 size) |
| { |
| int status; |
| s32 buffer_count = 0; |
| bool dirty = false; |
| u32 i; |
| void __iomem *base_address = drvdata->base_address; |
| |
| /* Loop through all the data */ |
| for (i = 0, buffer_count = 0; i < size; i++) { |
| |
| /* Copy data to bram */ |
| buffer_icap_set_bram(base_address, buffer_count, data[i]); |
| dirty = true; |
| |
| if (buffer_count < XHI_MAX_BUFFER_INTS - 1) { |
| buffer_count++; |
| continue; |
| } |
| |
| /* Write data to ICAP */ |
| status = buffer_icap_device_write( |
| drvdata, |
| XHI_BUFFER_START, |
| XHI_MAX_BUFFER_INTS); |
| if (status != 0) { |
| /* abort. */ |
| buffer_icap_reset(drvdata); |
| return status; |
| } |
| |
| buffer_count = 0; |
| dirty = false; |
| } |
| |
| /* Write unwritten data to ICAP */ |
| if (dirty) { |
| /* Write data to ICAP */ |
| status = buffer_icap_device_write(drvdata, XHI_BUFFER_START, |
| buffer_count); |
| if (status != 0) { |
| /* abort. */ |
| buffer_icap_reset(drvdata); |
| } |
| return status; |
| } |
| |
| return 0; |
| }; |
| |
| /** |
| * buffer_icap_get_configuration - Read configuration data from the device. |
| * @drvdata: a pointer to the drvdata. |
| * @data: Address of the data representing the partial bitstream |
| * @size: the size of the partial bitstream in 32 bit words. |
| **/ |
| int buffer_icap_get_configuration(struct hwicap_drvdata *drvdata, u32 *data, |
| u32 size) |
| { |
| int status; |
| s32 buffer_count = 0; |
| u32 i; |
| void __iomem *base_address = drvdata->base_address; |
| |
| /* Loop through all the data */ |
| for (i = 0, buffer_count = XHI_MAX_BUFFER_INTS; i < size; i++) { |
| if (buffer_count == XHI_MAX_BUFFER_INTS) { |
| u32 words_remaining = size - i; |
| u32 words_to_read = |
| words_remaining < |
| XHI_MAX_BUFFER_INTS ? words_remaining : |
| XHI_MAX_BUFFER_INTS; |
| |
| /* Read data from ICAP */ |
| status = buffer_icap_device_read( |
| drvdata, |
| XHI_BUFFER_START, |
| words_to_read); |
| if (status != 0) { |
| /* abort. */ |
| buffer_icap_reset(drvdata); |
| return status; |
| } |
| |
| buffer_count = 0; |
| } |
| |
| /* Copy data from bram */ |
| data[i] = buffer_icap_get_bram(base_address, buffer_count); |
| buffer_count++; |
| } |
| |
| return 0; |
| }; |
