12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231 |
- --- a/drivers/char/Kconfig
- +++ b/drivers/char/Kconfig
- @@ -387,6 +387,13 @@ config XILINX_HWICAP
-
- If unsure, say N.
-
- +config XILINX_DEVCFG
- + tristate "Xilinx Device Configuration"
- + depends on ARCH_ZYNQ
- + help
- + This option enables support for the Xilinx device configuration driver.
- + If unsure, say N
- +
- config R3964
- tristate "Siemens R3964 line discipline"
- depends on TTY
- --- a/drivers/char/Makefile
- +++ b/drivers/char/Makefile
- @@ -29,6 +29,7 @@ obj-$(CONFIG_GEN_RTC) += genrtc.o
- obj-$(CONFIG_EFI_RTC) += efirtc.o
- obj-$(CONFIG_DS1302) += ds1302.o
- obj-$(CONFIG_XILINX_HWICAP) += xilinx_hwicap/
- +obj-$(CONFIG_XILINX_DEVCFG) += xilinx_devcfg.o
- ifeq ($(CONFIG_GENERIC_NVRAM),y)
- obj-$(CONFIG_NVRAM) += generic_nvram.o
- else
- --- /dev/null
- +++ b/drivers/char/xilinx_devcfg.c
- @@ -0,0 +1,2105 @@
- +/*
- + * Xilinx Zynq Device Config driver
- + *
- + * Copyright (c) 2011 - 2013 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.
- + */
- +
- +#include <linux/cdev.h>
- +#include <linux/clk.h>
- +#include <linux/delay.h>
- +#include <linux/dma-mapping.h>
- +#include <linux/fs.h>
- +#include <linux/init.h>
- +#include <linux/interrupt.h>
- +#include <linux/io.h>
- +#include <linux/ioport.h>
- +#include <linux/kernel.h>
- +#include <linux/module.h>
- +#include <linux/mutex.h>
- +#include <linux/of.h>
- +#include <linux/platform_device.h>
- +#include <linux/slab.h>
- +#include <linux/string.h>
- +#include <linux/sysctl.h>
- +#include <linux/types.h>
- +#include <linux/uaccess.h>
- +
- +extern void zynq_slcr_init_preload_fpga(void);
- +extern void zynq_slcr_init_postload_fpga(void);
- +
- +#define DRIVER_NAME "xdevcfg"
- +#define XDEVCFG_DEVICES 1
- +
- +/* An array, which is set to true when the device is registered. */
- +static DEFINE_MUTEX(xdevcfg_mutex);
- +
- +/* Constant Definitions */
- +#define XDCFG_CTRL_OFFSET 0x00 /* Control Register */
- +#define XDCFG_LOCK_OFFSET 0x04 /* Lock Register */
- +#define XDCFG_INT_STS_OFFSET 0x0C /* Interrupt Status Register */
- +#define XDCFG_INT_MASK_OFFSET 0x10 /* Interrupt Mask Register */
- +#define XDCFG_STATUS_OFFSET 0x14 /* Status Register */
- +#define XDCFG_DMA_SRC_ADDR_OFFSET 0x18 /* DMA Source Address Register */
- +#define XDCFG_DMA_DEST_ADDR_OFFSET 0x1C /* DMA Destination Address Reg */
- +#define XDCFG_DMA_SRC_LEN_OFFSET 0x20 /* DMA Source Transfer Length */
- +#define XDCFG_DMA_DEST_LEN_OFFSET 0x24 /* DMA Destination Transfer */
- +#define XDCFG_UNLOCK_OFFSET 0x34 /* Unlock Register */
- +#define XDCFG_MCTRL_OFFSET 0x80 /* Misc. Control Register */
- +
- +/* Control Register Bit definitions */
- +#define XDCFG_CTRL_PCFG_PROG_B_MASK 0x40000000 /* Program signal to
- + * Reset FPGA */
- +#define XDCFG_CTRL_PCAP_PR_MASK 0x08000000 /* Enable PCAP for PR */
- +#define XDCFG_CTRL_PCAP_MODE_MASK 0x04000000 /* Enable PCAP */
- +#define XDCFG_CTRL_PCAP_RATE_EN_MASK 0x02000000 /* Enable PCAP Quad Rate */
- +#define XDCFG_CTRL_PCFG_AES_EN_MASK 0x00000E00 /* AES Enable Mask */
- +#define XDCFG_CTRL_SEU_EN_MASK 0x00000100 /* SEU Enable Mask */
- +#define XDCFG_CTRL_SPNIDEN_MASK 0x00000040 /* Secure Non Invasive
- + * Debug Enable */
- +#define XDCFG_CTRL_SPIDEN_MASK 0x00000020 /* Secure Invasive
- + * Debug Enable */
- +#define XDCFG_CTRL_NIDEN_MASK 0x00000010 /* Non-Invasive Debug
- + * Enable */
- +#define XDCFG_CTRL_DBGEN_MASK 0x00000008 /* Invasive Debug
- + * Enable */
- +#define XDCFG_CTRL_DAP_EN_MASK 0x00000007 /* DAP Enable Mask */
- +
- +/* Lock register bit definitions */
- +
- +#define XDCFG_LOCK_AES_EN_MASK 0x00000008 /* Lock AES_EN update */
- +#define XDCFG_LOCK_SEU_MASK 0x00000004 /* Lock SEU_En update */
- +#define XDCFG_LOCK_DBG_MASK 0x00000001 /* This bit locks
- + * security config
- + * including: DAP_En,
- + * DBGEN,NIDEN, SPNIEN */
- +
- +/* Miscellaneous Control Register bit definitions */
- +#define XDCFG_MCTRL_PCAP_LPBK_MASK 0x00000010 /* Internal PCAP loopback */
- +
- +/* Status register bit definitions */
- +#define XDCFG_STATUS_PCFG_INIT_MASK 0x00000010 /* FPGA init status */
- +
- +/* Interrupt Status/Mask Register Bit definitions */
- +#define XDCFG_IXR_DMA_DONE_MASK 0x00002000 /* DMA Command Done */
- +#define XDCFG_IXR_D_P_DONE_MASK 0x00001000 /* DMA and PCAP Cmd Done */
- +#define XDCFG_IXR_PCFG_DONE_MASK 0x00000004 /* FPGA programmed */
- +#define XDCFG_IXR_ERROR_FLAGS_MASK 0x00F0F860
- +#define XDCFG_IXR_ALL_MASK 0xF8F7F87F
- +/* Miscellaneous constant values */
- +#define XDCFG_DMA_INVALID_ADDRESS 0xFFFFFFFF /* Invalid DMA address */
- +
- +static const char * const fclk_name[] = {
- + "fclk0",
- + "fclk1",
- + "fclk2",
- + "fclk3"
- +};
- +#define NUMFCLKS ARRAY_SIZE(fclk_name)
- +
- +/**
- + * struct xdevcfg_drvdata - Device Configuration driver structure
- + *
- + * @dev: Pointer to the device structure
- + * @cdev: Instance of the cdev structure
- + * @devt: Pointer to the dev_t structure
- + * @class: Pointer to device class
- + * @fclk_class: Pointer to fclk device class
- + * @dma_done: The dma_done status bit for the DMA command completion
- + * @error_status: The error status captured during the DMA transfer
- + * @irq: Interrupt number
- + * @clk: Peripheral clock for devcfg
- + * @fclk: Array holding references to the FPGA clocks
- + * @fclk_exported: Flag inidcating whether an FPGA clock is exported
- + * @is_open: The status bit to indicate whether the device is opened
- + * @sem: Instance for the mutex
- + * @lock: Instance of spinlock
- + * @base_address: The virtual device base address of the device registers
- + * @is_partial_bitstream: Status bit to indicate partial/full bitstream
- + */
- +struct xdevcfg_drvdata {
- + struct device *dev;
- + struct cdev cdev;
- + dev_t devt;
- + struct class *class;
- + struct class *fclk_class;
- + int irq;
- + struct clk *clk;
- + struct clk *fclk[NUMFCLKS];
- + u8 fclk_exported[NUMFCLKS];
- + volatile bool dma_done;
- + volatile int error_status;
- + bool is_open;
- + struct mutex sem;
- + spinlock_t lock;
- + void __iomem *base_address;
- + int ep107;
- + bool is_partial_bitstream;
- + bool endian_swap;
- + char residue_buf[3];
- + int residue_len;
- +};
- +
- +/**
- + * struct fclk_data - FPGA clock data
- + * @clk: Pointer to clock
- + * @enable: Flag indicating enable status of the clock
- + * @rate_rnd: Rate to be rounded for round rate operation
- + */
- +struct fclk_data {
- + struct clk *clk;
- + int enabled;
- + unsigned long rate_rnd;
- +};
- +
- +/* Register read/write access routines */
- +#define xdevcfg_writereg(offset, val) __raw_writel(val, offset)
- +#define xdevcfg_readreg(offset) __raw_readl(offset)
- +
- +/**
- + * xdevcfg_reset_pl() - Reset the programmable logic.
- + * @base_address: The base address of the device.
- + *
- + * Must be called with PCAP clock enabled
- + */
- +static void xdevcfg_reset_pl(void __iomem *base_address)
- +{
- + /*
- + * Create a rising edge on PCFG_INIT. PCFG_INIT follows PCFG_PROG_B,
- + * so we need to * poll it after setting PCFG_PROG_B to make sure that
- + * the rising edge happens.
- + */
- + xdevcfg_writereg(base_address + XDCFG_CTRL_OFFSET,
- + (xdevcfg_readreg(base_address + XDCFG_CTRL_OFFSET) |
- + XDCFG_CTRL_PCFG_PROG_B_MASK));
- + while (!(xdevcfg_readreg(base_address + XDCFG_STATUS_OFFSET) &
- + XDCFG_STATUS_PCFG_INIT_MASK))
- + ;
- +
- + xdevcfg_writereg(base_address + XDCFG_CTRL_OFFSET,
- + (xdevcfg_readreg(base_address + XDCFG_CTRL_OFFSET) &
- + ~XDCFG_CTRL_PCFG_PROG_B_MASK));
- + while (xdevcfg_readreg(base_address + XDCFG_STATUS_OFFSET) &
- + XDCFG_STATUS_PCFG_INIT_MASK)
- + ;
- +
- + msleep(5);
- + xdevcfg_writereg(base_address + XDCFG_CTRL_OFFSET,
- + (xdevcfg_readreg(base_address + XDCFG_CTRL_OFFSET) |
- + XDCFG_CTRL_PCFG_PROG_B_MASK));
- + while (!(xdevcfg_readreg(base_address + XDCFG_STATUS_OFFSET) &
- + XDCFG_STATUS_PCFG_INIT_MASK))
- + ;
- +}
- +
- +/**
- + * xdevcfg_irq() - The main interrupt handler.
- + * @irq: The interrupt number.
- + * @data: Pointer to the driver data structure.
- + * returns: IRQ_HANDLED after the interrupt is handled.
- + **/
- +static irqreturn_t xdevcfg_irq(int irq, void *data)
- +{
- + u32 intr_status;
- + struct xdevcfg_drvdata *drvdata = data;
- +
- + spin_lock(&drvdata->lock);
- +
- + intr_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_INT_STS_OFFSET);
- +
- + /* Clear the interrupts */
- + xdevcfg_writereg(drvdata->base_address + XDCFG_INT_STS_OFFSET,
- + intr_status);
- +
- + if ((intr_status & XDCFG_IXR_D_P_DONE_MASK) ==
- + XDCFG_IXR_D_P_DONE_MASK)
- + drvdata->dma_done = 1;
- +
- + if ((intr_status & XDCFG_IXR_ERROR_FLAGS_MASK) ==
- + XDCFG_IXR_ERROR_FLAGS_MASK)
- + drvdata->error_status = 1;
- +
- + spin_unlock(&drvdata->lock);
- +
- + return IRQ_HANDLED;
- +}
- +
- +/**
- + * xdevcfg_write() - The is the driver write function.
- + *
- + * @file: Pointer to the file structure.
- + * @buf: Pointer to the bitstream location.
- + * @count: The number of bytes to be written.
- + * @ppos: Pointer to the offset value
- + * returns: Success or error status.
- + **/
- +static ssize_t
- +xdevcfg_write(struct file *file, const char __user *buf, size_t count,
- + loff_t *ppos)
- +{
- + char *kbuf;
- + int status;
- + unsigned long timeout;
- + u32 intr_reg, dma_len;
- + dma_addr_t dma_addr;
- + u32 transfer_length = 0;
- + struct xdevcfg_drvdata *drvdata = file->private_data;
- + size_t user_count = count;
- + int i;
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + status = mutex_lock_interruptible(&drvdata->sem);
- +
- + if (status)
- + goto err_clk;
- +
- + dma_len = count + drvdata->residue_len;
- + kbuf = dma_alloc_coherent(drvdata->dev, dma_len, &dma_addr, GFP_KERNEL);
- + if (!kbuf) {
- + status = -ENOMEM;
- + goto err_unlock;
- + }
- +
- + /* Collect stragglers from last time (0 to 3 bytes) */
- + memcpy(kbuf, drvdata->residue_buf, drvdata->residue_len);
- +
- + /* Fetch user data, appending to stragglers */
- + if (copy_from_user(kbuf + drvdata->residue_len, buf, count)) {
- + status = -EFAULT;
- + goto error;
- + }
- +
- + /* Include stragglers in total bytes to be handled */
- + count += drvdata->residue_len;
- +
- + /* First block contains a header */
- + if (*ppos == 0 && count > 4) {
- + /* Look for sync word */
- + for (i = 0; i < count - 4; i++) {
- + if (memcmp(kbuf + i, "\x66\x55\x99\xAA", 4) == 0) {
- + pr_debug("Found normal sync word\n");
- + drvdata->endian_swap = 0;
- + break;
- + }
- + if (memcmp(kbuf + i, "\xAA\x99\x55\x66", 4) == 0) {
- + pr_debug("Found swapped sync word\n");
- + drvdata->endian_swap = 1;
- + break;
- + }
- + }
- + /* Remove the header, aligning the data on word boundary */
- + if (i != count - 4) {
- + count -= i;
- + memmove(kbuf, kbuf + i, count);
- + }
- + }
- +
- + /* Save stragglers for next time */
- + drvdata->residue_len = count % 4;
- + count -= drvdata->residue_len;
- + memcpy(drvdata->residue_buf, kbuf + count, drvdata->residue_len);
- +
- + /* Fixup endianess of the data */
- + if (drvdata->endian_swap) {
- + for (i = 0; i < count; i += 4) {
- + u32 *p = (u32 *)&kbuf[i];
- + *p = swab32(*p);
- + }
- + }
- +
- + /* Enable DMA and error interrupts */
- + xdevcfg_writereg(drvdata->base_address + XDCFG_INT_STS_OFFSET,
- + XDCFG_IXR_ALL_MASK);
- +
- +
- + xdevcfg_writereg(drvdata->base_address + XDCFG_INT_MASK_OFFSET,
- + (u32) (~(XDCFG_IXR_D_P_DONE_MASK |
- + XDCFG_IXR_ERROR_FLAGS_MASK)));
- +
- + drvdata->dma_done = 0;
- + drvdata->error_status = 0;
- +
- + /* Initiate DMA write command */
- + if (count < 0x1000)
- + xdevcfg_writereg(drvdata->base_address +
- + XDCFG_DMA_SRC_ADDR_OFFSET, (u32)(dma_addr + 1));
- + else
- + xdevcfg_writereg(drvdata->base_address +
- + XDCFG_DMA_SRC_ADDR_OFFSET, (u32) dma_addr);
- +
- + xdevcfg_writereg(drvdata->base_address + XDCFG_DMA_DEST_ADDR_OFFSET,
- + (u32)XDCFG_DMA_INVALID_ADDRESS);
- + /* Convert number of bytes to number of words. */
- + if (count % 4)
- + transfer_length = (count / 4 + 1);
- + else
- + transfer_length = count / 4;
- + xdevcfg_writereg(drvdata->base_address + XDCFG_DMA_SRC_LEN_OFFSET,
- + transfer_length);
- + xdevcfg_writereg(drvdata->base_address + XDCFG_DMA_DEST_LEN_OFFSET, 0);
- +
- + timeout = jiffies + msecs_to_jiffies(1000);
- +
- + while (!drvdata->dma_done) {
- + if (time_after(jiffies, timeout)) {
- + status = -ETIMEDOUT;
- + goto error;
- + }
- + }
- +
- + if (drvdata->error_status)
- + status = drvdata->error_status;
- +
- + /* Disable the DMA and error interrupts */
- + intr_reg = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_INT_MASK_OFFSET);
- + xdevcfg_writereg(drvdata->base_address + XDCFG_INT_MASK_OFFSET,
- + intr_reg | (XDCFG_IXR_D_P_DONE_MASK |
- + XDCFG_IXR_ERROR_FLAGS_MASK));
- +
- + /* If we didn't write correctly, then bail out. */
- + if (status) {
- + status = -EFAULT;
- + goto error;
- + }
- +
- + *ppos += user_count;
- + status = user_count;
- +
- +error:
- + dma_free_coherent(drvdata->dev, dma_len, kbuf, dma_addr);
- +err_unlock:
- + mutex_unlock(&drvdata->sem);
- +err_clk:
- + clk_disable(drvdata->clk);
- + return status;
- +}
- +
- +
- +/**
- + * xdevcfg_read() - The is the driver read function.
- + * @file: Pointer to the file structure.
- + * @buf: Pointer to the bitstream location.
- + * @count: The number of bytes read.
- + * @ppos: Pointer to the offsetvalue
- + * returns: Success or error status.
- + */
- +static ssize_t
- +xdevcfg_read(struct file *file, char __user *buf, size_t count, loff_t *ppos)
- +{
- + u32 *kbuf;
- + int status;
- + unsigned long timeout;
- + dma_addr_t dma_addr;
- + struct xdevcfg_drvdata *drvdata = file->private_data;
- + u32 intr_reg;
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + status = mutex_lock_interruptible(&drvdata->sem);
- + if (status)
- + goto err_clk;
- +
- + /* Get new data from the ICAP, and return was requested. */
- + kbuf = dma_alloc_coherent(drvdata->dev, count, &dma_addr, GFP_KERNEL);
- + if (!kbuf) {
- + status = -ENOMEM;
- + goto err_unlock;
- + }
- +
- + drvdata->dma_done = 0;
- + drvdata->error_status = 0;
- +
- + /* Enable DMA and error interrupts */
- + xdevcfg_writereg(drvdata->base_address + XDCFG_INT_STS_OFFSET,
- + XDCFG_IXR_ALL_MASK);
- +
- + xdevcfg_writereg(drvdata->base_address + XDCFG_INT_MASK_OFFSET,
- + (u32) (~(XDCFG_IXR_D_P_DONE_MASK |
- + XDCFG_IXR_ERROR_FLAGS_MASK)));
- + /* Initiate DMA read command */
- + xdevcfg_writereg(drvdata->base_address + XDCFG_DMA_SRC_ADDR_OFFSET,
- + (u32)XDCFG_DMA_INVALID_ADDRESS);
- + xdevcfg_writereg(drvdata->base_address + XDCFG_DMA_DEST_ADDR_OFFSET,
- + (u32)dma_addr);
- + xdevcfg_writereg(drvdata->base_address + XDCFG_DMA_SRC_LEN_OFFSET, 0);
- + xdevcfg_writereg(drvdata->base_address + XDCFG_DMA_DEST_LEN_OFFSET,
- + count / 4);
- +
- + timeout = jiffies + msecs_to_jiffies(1000);
- +
- + while (!drvdata->dma_done) {
- + if (time_after(jiffies, timeout)) {
- + status = -ETIMEDOUT;
- + goto error;
- + }
- + }
- +
- + if (drvdata->error_status)
- + status = drvdata->error_status;
- +
- + /* Disable and clear DMA and error interrupts */
- + intr_reg = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_INT_MASK_OFFSET);
- + xdevcfg_writereg(drvdata->base_address + XDCFG_INT_MASK_OFFSET,
- + intr_reg | (XDCFG_IXR_D_P_DONE_MASK |
- + XDCFG_IXR_ERROR_FLAGS_MASK));
- +
- +
- + /* If we didn't read correctly, then bail out. */
- + if (status) {
- + status = -EFAULT;
- + goto error;
- + }
- +
- + /* If we fail to return the data to the user, then bail out. */
- + if (copy_to_user(buf, kbuf, count)) {
- + status = -EFAULT;
- + goto error;
- + }
- +
- + status = count;
- +error:
- + dma_free_coherent(drvdata->dev, count, kbuf, dma_addr);
- +err_unlock:
- + mutex_unlock(&drvdata->sem);
- +err_clk:
- + clk_disable(drvdata->clk);
- +
- + return status;
- +}
- +
- +static void xdevcfg_enable_partial(struct xdevcfg_drvdata *drvdata)
- +{
- + u32 reg = xdevcfg_readreg(drvdata->base_address + XDCFG_CTRL_OFFSET);
- +
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + reg | XDCFG_CTRL_PCAP_PR_MASK);
- +}
- +
- +static void xdevcfg_disable_partial(struct xdevcfg_drvdata *drvdata)
- +{
- + u32 reg = xdevcfg_readreg(drvdata->base_address + XDCFG_CTRL_OFFSET);
- +
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + reg & ~XDCFG_CTRL_PCAP_PR_MASK);
- +}
- +
- +/**
- + * xdevcfg_open() - The is the driver open function.
- + * @inode: Pointer to the inode structure of this device.
- + * @file: Pointer to the file structure.
- + * returns: Success or error status.
- + */
- +static int xdevcfg_open(struct inode *inode, struct file *file)
- +{
- + struct xdevcfg_drvdata *drvdata;
- + int status;
- +
- + drvdata = container_of(inode->i_cdev, struct xdevcfg_drvdata, cdev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + status = mutex_lock_interruptible(&drvdata->sem);
- + if (status)
- + goto err_clk;
- +
- + if (drvdata->is_open) {
- + status = -EBUSY;
- + goto error;
- + }
- +
- + file->private_data = drvdata;
- + drvdata->is_open = 1;
- + drvdata->endian_swap = 0;
- + drvdata->residue_len= 0;
- +
- + /*
- + * If is_partial_bitstream is set, then PROG_B is not asserted
- + * (xdevcfg_reset_pl function) and also zynq_slcr_init_preload_fpga and
- + * zynq_slcr_init_postload_fpga functions are not invoked.
- + */
- + if (drvdata->is_partial_bitstream)
- + xdevcfg_enable_partial(drvdata);
- + else
- + zynq_slcr_init_preload_fpga();
- +
- + /*
- + * Only do the reset of the PL for Zynq as it causes problems on the
- + * EP107 and the issue is not understood, but not worth investigating
- + * as the emulation platform is very different than silicon and not a
- + * complete implementation. Also, do not reset if it is a partial
- + * bitstream.
- + */
- + if ((!drvdata->ep107) && (!drvdata->is_partial_bitstream))
- + xdevcfg_reset_pl(drvdata->base_address);
- +
- + xdevcfg_writereg(drvdata->base_address + XDCFG_INT_STS_OFFSET,
- + XDCFG_IXR_PCFG_DONE_MASK);
- +
- +error:
- + mutex_unlock(&drvdata->sem);
- +err_clk:
- + clk_disable(drvdata->clk);
- + return status;
- +}
- +
- +/**
- + * xdevcfg_release() - The is the driver release function.
- + * @inode: Pointer to the inode structure of this device.
- + * @file: Pointer to the file structure.
- + * returns: Success.
- + */
- +static int xdevcfg_release(struct inode *inode, struct file *file)
- +{
- + struct xdevcfg_drvdata *drvdata = file->private_data;
- +
- + if (drvdata->is_partial_bitstream)
- + xdevcfg_disable_partial(drvdata);
- + else
- + zynq_slcr_init_postload_fpga();
- +
- +
- + if (drvdata->residue_len)
- + printk("Did not transfer last %d bytes\n",
- + drvdata->residue_len);
- +
- + drvdata->is_open = 0;
- +
- + return 0;
- +}
- +
- +static const struct file_operations xdevcfg_fops = {
- + .owner = THIS_MODULE,
- + .write = xdevcfg_write,
- + .read = xdevcfg_read,
- + .open = xdevcfg_open,
- + .release = xdevcfg_release,
- +};
- +
- +/*
- + * The following functions are the routines provided to the user to
- + * set/get the status bit value in the control/lock registers.
- + */
- +
- +/**
- + * xdevcfg_set_dap_en() - This function sets the DAP bits in the
- + * control register with the given value.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * @size: The number of bytes used from the buffer
- + * returns: negative error if the string could not be converted
- + * or the size of the buffer.
- + */
- +static ssize_t xdevcfg_set_dap_en(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t size)
- +{
- + u32 ctrl_reg_status;
- + unsigned long flags;
- + unsigned long mask_bit;
- + int status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + ctrl_reg_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET);
- + spin_lock_irqsave(&drvdata->lock, flags);
- +
- + status = kstrtoul(buf, 10, &mask_bit);
- +
- + if (status)
- + goto err_unlock;
- +
- + if (mask_bit > 7) {
- + status = -EINVAL;
- + goto err_unlock;
- + }
- +
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + (ctrl_reg_status |
- + (((u32)mask_bit) & XDCFG_CTRL_DAP_EN_MASK)));
- +
- + spin_unlock_irqrestore(&drvdata->lock, flags);
- +
- + clk_disable(drvdata->clk);
- +
- + return size;
- +
- +err_unlock:
- + spin_unlock_irqrestore(&drvdata->lock, flags);
- + clk_disable(drvdata->clk);
- +
- + return status;
- +}
- +
- +/**
- + * xdevcfg_show_dap_en_status() - The function returns the DAP_EN bits status in
- + * the control register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * returns: Size of the buffer.
- + */
- +static ssize_t xdevcfg_show_dap_en_status(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + u32 dap_en_status;
- + int status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + dap_en_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET) & XDCFG_CTRL_DAP_EN_MASK;
- +
- + clk_disable(drvdata->clk);
- +
- + status = sprintf(buf, "%d\n", dap_en_status);
- +
- + return status;
- +}
- +
- +static DEVICE_ATTR(enable_dap, 0644, xdevcfg_show_dap_en_status,
- + xdevcfg_set_dap_en);
- +
- +/**
- + * xdevcfg_set_dbgen() - This function sets the DBGEN bit in the
- + * control register with the given value.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * @size: The number of bytes used from the buffer
- + * returns: -EINVAL if invalid parameter is sent or size
- + */
- +static ssize_t xdevcfg_set_dbgen(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t size)
- +{
- + u32 ctrl_reg_status;
- + unsigned long flags;
- + unsigned long mask_bit;
- + int status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + ctrl_reg_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET);
- +
- + status = kstrtoul(buf, 10, &mask_bit);
- +
- + if (status)
- + goto err_clk;
- +
- + if (mask_bit > 1) {
- + status = -EINVAL;
- + goto err_clk;
- + }
- +
- + spin_lock_irqsave(&drvdata->lock, flags);
- +
- + if (mask_bit)
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + (ctrl_reg_status | XDCFG_CTRL_DBGEN_MASK));
- + else
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + (ctrl_reg_status & (~XDCFG_CTRL_DBGEN_MASK)));
- +
- + spin_unlock_irqrestore(&drvdata->lock, flags);
- +
- + clk_disable(drvdata->clk);
- +
- + return size;
- +
- +err_clk:
- + clk_disable(drvdata->clk);
- +
- + return status;
- +}
- +
- +/**
- + * xdevcfg_show_dbgen_status() - The function returns the DBGEN bit status in
- + * the control register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * returns: Size of the buffer.
- + */
- +static ssize_t xdevcfg_show_dbgen_status(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + u32 dbgen_status;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + dbgen_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET) & XDCFG_CTRL_DBGEN_MASK;
- +
- + clk_disable(drvdata->clk);
- +
- + status = sprintf(buf, "%d\n", (dbgen_status >> 3));
- +
- + return status;
- +}
- +
- +static DEVICE_ATTR(enable_dbg_in, 0644, xdevcfg_show_dbgen_status,
- + xdevcfg_set_dbgen);
- +
- +/**
- + * xdevcfg_set_niden() - This function sets the NIDEN bit in the
- + * control register with the given value.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * @size: The number of bytes used from the buffer
- + * returns: -EINVAL if invalid parameter is sent or size
- + */
- +static ssize_t xdevcfg_set_niden(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t size)
- +{
- + u32 ctrl_reg_status;
- + unsigned long flags;
- + unsigned long mask_bit;
- + int status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + ctrl_reg_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET);
- +
- + status = kstrtoul(buf, 10, &mask_bit);
- +
- + if (status)
- + goto err_clk;
- +
- + if (mask_bit > 1) {
- + status = -EINVAL;
- + goto err_clk;
- + }
- +
- + spin_lock_irqsave(&drvdata->lock, flags);
- +
- + if (mask_bit)
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + (ctrl_reg_status | XDCFG_CTRL_NIDEN_MASK));
- + else
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + (ctrl_reg_status & (~XDCFG_CTRL_NIDEN_MASK)));
- +
- + spin_unlock_irqrestore(&drvdata->lock, flags);
- +
- + clk_disable(drvdata->clk);
- +
- + return size;
- +
- +err_clk:
- + clk_disable(drvdata->clk);
- +
- + return status;
- +}
- +
- +/**
- + * xdevcfg_show_niden_status() - The function returns the NIDEN bit status in
- + * the control register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * returns: Size of the buffer.
- + */
- +static ssize_t xdevcfg_show_niden_status(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + u32 niden_status;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + niden_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET) & XDCFG_CTRL_NIDEN_MASK;
- +
- + clk_disable(drvdata->clk);
- +
- + status = sprintf(buf, "%d\n", (niden_status >> 4));
- +
- + return status;
- +}
- +
- +static DEVICE_ATTR(enable_dbg_nonin, 0644, xdevcfg_show_niden_status,
- + xdevcfg_set_niden);
- +
- +/**
- + * xdevcfg_set_spiden() - This function sets the SPIDEN bit in the
- + * control register with the given value.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * @size: The number of bytes used from the buffer
- + * returns: -EINVAL if invalid parameter is sent or size
- + */
- +static ssize_t xdevcfg_set_spiden(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t size)
- +{
- + u32 ctrl_reg_status;
- + unsigned long flags;
- + unsigned long mask_bit;
- + int status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + ctrl_reg_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET);
- +
- + status = kstrtoul(buf, 10, &mask_bit);
- +
- + if (status)
- + goto err_clk;
- +
- + if (mask_bit > 1) {
- + status = -EINVAL;
- + goto err_clk;
- + }
- +
- + spin_lock_irqsave(&drvdata->lock, flags);
- +
- + if (mask_bit)
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + (ctrl_reg_status | XDCFG_CTRL_SPIDEN_MASK));
- + else
- +
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + (ctrl_reg_status & (~XDCFG_CTRL_SPIDEN_MASK)));
- +
- + spin_unlock_irqrestore(&drvdata->lock, flags);
- +
- + clk_disable(drvdata->clk);
- +
- + return size;
- +
- +err_clk:
- + clk_disable(drvdata->clk);
- +
- + return status;
- +}
- +
- +/**
- + * xdevcfg_show_spiden_status() - The function returns the SPIDEN bit status in
- + * the control register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * returns: Size of the buffer.
- + */
- +static ssize_t xdevcfg_show_spiden_status(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + u32 spiden_status;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + spiden_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET) & XDCFG_CTRL_SPIDEN_MASK;
- +
- + clk_disable(drvdata->clk);
- +
- + status = sprintf(buf, "%d\n", (spiden_status >> 5));
- +
- + return status;
- +}
- +
- +static DEVICE_ATTR(enable_sec_dbg_in, 0644, xdevcfg_show_spiden_status,
- + xdevcfg_set_spiden);
- +
- +/**
- + * xdevcfg_set_spniden() - This function sets the SPNIDEN bit in the
- + * control register with the given value.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * @size: The number of bytes used from the buffer
- + * returns: -EINVAL if invalid parameter is sent or the size of buffer
- + */
- +static ssize_t xdevcfg_set_spniden(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t size)
- +{
- + u32 ctrl_reg_status;
- + unsigned long flags;
- + unsigned long mask_bit;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + ctrl_reg_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET);
- + status = kstrtoul(buf, 10, &mask_bit);
- +
- + if (status)
- + goto err_clk;
- +
- + if (mask_bit > 1) {
- + status = -EINVAL;
- + goto err_clk;
- + }
- +
- + spin_lock_irqsave(&drvdata->lock, flags);
- +
- + if (mask_bit)
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + (ctrl_reg_status | XDCFG_CTRL_SPNIDEN_MASK));
- + else
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + (ctrl_reg_status & (~XDCFG_CTRL_SPNIDEN_MASK)));
- +
- + spin_unlock_irqrestore(&drvdata->lock, flags);
- +
- + clk_disable(drvdata->clk);
- +
- + return size;
- +
- +err_clk:
- + clk_disable(drvdata->clk);
- +
- + return status;
- +}
- +
- +/**
- + * xdevcfg_show_spniden_status() - The function returns the SPNIDEN bit status
- + * in the control register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * returns: Size of the buffer.
- + */
- +static ssize_t xdevcfg_show_spniden_status(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + u32 spniden_status;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + spniden_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET) & XDCFG_CTRL_SPNIDEN_MASK;
- +
- + clk_disable(drvdata->clk);
- +
- + status = sprintf(buf, "%d\n", (spniden_status >> 6));
- +
- + return status;
- +}
- +
- +static DEVICE_ATTR(enable_sec_dbg_nonin, 0644, xdevcfg_show_spniden_status,
- + xdevcfg_set_spniden);
- +
- +/**
- + * xdevcfg_set_seu() - This function sets the SEU_EN bit in the
- + * control register with the given value
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * @size: The number of bytes used from the buffer
- + * returns: -EINVAL if invalid parameter is sent or size
- + */
- +static ssize_t xdevcfg_set_seu(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t size)
- +{
- + u32 ctrl_reg_status;
- + unsigned long flags;
- + unsigned long mask_bit;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + ctrl_reg_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET);
- +
- + status = kstrtoul(buf, 10, &mask_bit);
- +
- + if (status)
- + goto err_clk;
- +
- + if (mask_bit > 1) {
- + status = -EINVAL;
- + goto err_clk;
- + }
- +
- + spin_lock_irqsave(&drvdata->lock, flags);
- +
- + if (mask_bit)
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + (ctrl_reg_status | XDCFG_CTRL_SEU_EN_MASK));
- + else
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + (ctrl_reg_status & (~XDCFG_CTRL_SEU_EN_MASK)));
- +
- + spin_unlock_irqrestore(&drvdata->lock, flags);
- +
- + clk_disable(drvdata->clk);
- +
- + return size;
- +
- +err_clk:
- + clk_disable(drvdata->clk);
- +
- + return status;
- +}
- +
- +/**
- + * xdevcfg_show_seu_status() - The function returns the SEU_EN bit status
- + * in the control register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * returns: size of the buffer.
- + */
- +static ssize_t xdevcfg_show_seu_status(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + u32 seu_status;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + seu_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET) & XDCFG_CTRL_SEU_EN_MASK;
- +
- + clk_disable(drvdata->clk);
- +
- + status = sprintf(buf, "%d\n", (seu_status > 8));
- +
- + return status;
- +}
- +
- +static DEVICE_ATTR(enable_seu, 0644, xdevcfg_show_seu_status, xdevcfg_set_seu);
- +
- +/**
- + * xdevcfg_set_aes() - This function sets the AES_EN bits in the
- + * control register with either all 1s or all 0s.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * @size: The number of bytes used from the buffer
- + * returns: -EINVAL if invalid parameter is sent or size
- + *
- + * The user must send only one bit in the buffer to notify whether he wants to
- + * either set or reset these bits.
- + */
- +static ssize_t xdevcfg_set_aes(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t size)
- +{
- + u32 ctrl_reg_status;
- + unsigned long flags;
- + unsigned long mask_bit;
- + int status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + ctrl_reg_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET);
- +
- + status = kstrtoul(buf, 10, &mask_bit);
- +
- + if (status < 0)
- + goto err_clk;
- +
- + if (mask_bit > 1) {
- + status = -EINVAL;
- + goto err_clk;
- + }
- +
- +
- + spin_lock_irqsave(&drvdata->lock, flags);
- +
- + if (mask_bit)
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + (ctrl_reg_status |
- + XDCFG_CTRL_PCFG_AES_EN_MASK |
- + XDCFG_CTRL_PCAP_RATE_EN_MASK));
- + else
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET,
- + (ctrl_reg_status &
- + ~(XDCFG_CTRL_PCFG_AES_EN_MASK |
- + XDCFG_CTRL_PCAP_RATE_EN_MASK)));
- +
- + spin_unlock_irqrestore(&drvdata->lock, flags);
- +
- + clk_disable(drvdata->clk);
- +
- + return size;
- +
- +err_clk:
- + clk_disable(drvdata->clk);
- +
- + return status;
- +}
- +
- +/**
- + * xdevcfg_show_aes_status() - The function returns the AES_EN bit status
- + * in the control register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * returns: size of the buffer.
- + */
- +static ssize_t xdevcfg_show_aes_status(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + u32 aes_status;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + aes_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_CTRL_OFFSET) & XDCFG_CTRL_PCFG_AES_EN_MASK;
- +
- + clk_disable(drvdata->clk);
- +
- + status = sprintf(buf, "%d\n", (aes_status >> 9));
- +
- + return status;
- +}
- +
- +static DEVICE_ATTR(enable_aes, 0644, xdevcfg_show_aes_status, xdevcfg_set_aes);
- +
- +/**
- + * xdevcfg_set_aes_en_lock() - This function sets the LOCK_AES_EN bit in the
- + * lock register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * @size: The number of bytes used from the buffer
- + * returns: -EINVAL if invalid parameter is sent or size
- + */
- +static ssize_t xdevcfg_set_aes_en_lock(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t size)
- +{
- + u32 aes_en_lock_status;
- + unsigned long flags;
- + unsigned long mask_bit;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + aes_en_lock_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_LOCK_OFFSET);
- +
- + status = kstrtoul(buf, 10, &mask_bit);
- +
- + if (status)
- + goto err_clk;
- +
- + if (mask_bit > 1) {
- + status = -EINVAL;
- + goto err_clk;
- + }
- +
- + spin_lock_irqsave(&drvdata->lock, flags);
- +
- + if (mask_bit)
- + xdevcfg_writereg(drvdata->base_address + XDCFG_LOCK_OFFSET,
- + (aes_en_lock_status | XDCFG_LOCK_AES_EN_MASK));
- + else
- + xdevcfg_writereg(drvdata->base_address + XDCFG_LOCK_OFFSET,
- + (aes_en_lock_status &
- + (~XDCFG_LOCK_AES_EN_MASK)));
- +
- + spin_unlock_irqrestore(&drvdata->lock, flags);
- +
- + clk_disable(drvdata->clk);
- +
- + return size;
- +
- +err_clk:
- + clk_disable(drvdata->clk);
- +
- + return status;
- +}
- +
- +/**
- + * xdevcfg_show_aes_en_lock_status() - The function returns the LOCK_AES_EN bit
- + * status in the lock register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * returns: size of the buffer.
- + */
- +static ssize_t xdevcfg_show_aes_en_lock_status(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + u32 aes_en_lock_status;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + aes_en_lock_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_LOCK_OFFSET) & XDCFG_LOCK_AES_EN_MASK;
- +
- + clk_disable(drvdata->clk);
- +
- + status = sprintf(buf, "%d\n", (aes_en_lock_status >> 3));
- +
- + return status;
- +}
- +
- +static DEVICE_ATTR(aes_en_lock, 0644, xdevcfg_show_aes_en_lock_status,
- + xdevcfg_set_aes_en_lock);
- +
- +/**
- + * xdevcfg_set_seu_lock() - This function sets the LOCK_SEU bit in the
- + * lock register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * @size: The number of bytes used from the buffer
- + * returns: -EINVAL if invalid parameter is sent or size
- + */
- +static ssize_t xdevcfg_set_seu_lock(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t size)
- +{
- + u32 seu_lock_status;
- + unsigned long flags;
- + unsigned long mask_bit;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + seu_lock_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_LOCK_OFFSET);
- +
- + status = kstrtoul(buf, 10, &mask_bit);
- +
- + if (status)
- + goto err_clk;
- +
- + if (mask_bit > 1) {
- + status = -EINVAL;
- + goto err_clk;
- + }
- +
- + spin_lock_irqsave(&drvdata->lock, flags);
- +
- + if (mask_bit)
- + xdevcfg_writereg(drvdata->base_address + XDCFG_LOCK_OFFSET,
- + (seu_lock_status | XDCFG_LOCK_SEU_MASK));
- + else
- + xdevcfg_writereg(drvdata->base_address + XDCFG_LOCK_OFFSET,
- + (seu_lock_status & (~XDCFG_LOCK_SEU_MASK)));
- +
- + spin_unlock_irqrestore(&drvdata->lock, flags);
- +
- + clk_disable(drvdata->clk);
- +
- + return size;
- +
- +err_clk:
- + clk_disable(drvdata->clk);
- +
- + return status;
- +}
- +
- +/**
- + * xdevcfg_show_seu_lock_status() - The function returns the LOCK_SEU bit
- + * status in the lock register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * returns: size of the buffer.
- + */
- +static ssize_t xdevcfg_show_seu_lock_status(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + u32 seu_lock_status;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + seu_lock_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_LOCK_OFFSET) & XDCFG_LOCK_SEU_MASK;
- +
- + clk_disable(drvdata->clk);
- +
- + status = sprintf(buf, "%d\n", (seu_lock_status >> 2));
- +
- + return status;
- +}
- +
- +static DEVICE_ATTR(seu_lock, 0644, xdevcfg_show_seu_lock_status,
- + xdevcfg_set_seu_lock);
- +
- +/**
- + * xdevcfg_set_dbg_lock() - This function sets the LOCK_DBG bit in the
- + * lock register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * @size: The number of bytes used from the buffer
- + * returns: -EINVAL if invalid parameter is sent or size
- + */
- +static ssize_t xdevcfg_set_dbg_lock(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t size)
- +{
- + u32 lock_reg_status;
- + unsigned long flags;
- + unsigned long mask_bit;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + lock_reg_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_LOCK_OFFSET);
- + status = kstrtoul(buf, 10, &mask_bit);
- +
- + if (status)
- + goto err_clk;
- +
- + if (mask_bit > 1) {
- + status = -EINVAL;
- + goto err_clk;
- + }
- +
- + spin_lock_irqsave(&drvdata->lock, flags);
- +
- + if (mask_bit)
- + xdevcfg_writereg(drvdata->base_address + XDCFG_LOCK_OFFSET,
- + (lock_reg_status | XDCFG_LOCK_DBG_MASK));
- + else
- + xdevcfg_writereg(drvdata->base_address + XDCFG_LOCK_OFFSET,
- + (lock_reg_status & (~XDCFG_LOCK_DBG_MASK)));
- +
- + spin_unlock_irqrestore(&drvdata->lock, flags);
- +
- + clk_disable(drvdata->clk);
- +
- + return size;
- +
- +err_clk:
- + clk_disable(drvdata->clk);
- +
- + return status;
- +}
- +
- +/**
- + * xdevcfg_show_dbg_lock_status() - The function returns the LOCK_DBG bit
- + * status in the lock register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * returns: size of the buffer.
- + */
- +static ssize_t xdevcfg_show_dbg_lock_status(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + u32 dbg_lock_status;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + dbg_lock_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_LOCK_OFFSET) & XDCFG_LOCK_DBG_MASK;
- +
- + clk_disable(drvdata->clk);
- +
- + status = sprintf(buf, "%d\n", dbg_lock_status);
- +
- + return status;
- +}
- +
- +static DEVICE_ATTR(dbg_lock, 0644, xdevcfg_show_dbg_lock_status,
- + xdevcfg_set_dbg_lock);
- +
- +/**
- + * xdevcfg_show_prog_done_status() - The function returns the PROG_DONE bit
- + * status in the interrupt status register.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * returns: size of the buffer.
- + */
- +static ssize_t xdevcfg_show_prog_done_status(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + u32 prog_done_status;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = clk_enable(drvdata->clk);
- + if (status)
- + return status;
- +
- + prog_done_status = xdevcfg_readreg(drvdata->base_address +
- + XDCFG_INT_STS_OFFSET) & XDCFG_IXR_PCFG_DONE_MASK;
- +
- + clk_disable(drvdata->clk);
- +
- + status = sprintf(buf, "%d\n", (prog_done_status >> 2));
- +
- + return status;
- +}
- +
- +static DEVICE_ATTR(prog_done, 0644, xdevcfg_show_prog_done_status,
- + NULL);
- +
- +/**
- + * xdevcfg_set_is_partial_bitstream() - This function sets the
- + * is_partial_bitstream variable. If is_partial_bitstream is set,
- + * then PROG_B is not asserted (xdevcfg_reset_pl) and also
- + * zynq_slcr_init_preload_fpga and zynq_slcr_init_postload_fpga functions
- + * are not invoked.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * @size: The number of bytes used from the buffer
- + * returns: -EINVAL if invalid parameter is sent or size
- + */
- +static ssize_t xdevcfg_set_is_partial_bitstream(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t size)
- +{
- + unsigned long mask_bit;
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = kstrtoul(buf, 10, &mask_bit);
- +
- + if (status)
- + return status;
- +
- + if (mask_bit > 1)
- + return -EINVAL;
- +
- + if (mask_bit)
- + drvdata->is_partial_bitstream = 1;
- + else
- + drvdata->is_partial_bitstream = 0;
- +
- + return size;
- +}
- +
- +/**
- + * xdevcfg_show_is_partial_bitstream_status() - The function returns the
- + * value of is_partial_bitstream variable.
- + * @dev: Pointer to the device structure.
- + * @attr: Pointer to the device attribute structure.
- + * @buf: Pointer to the buffer location for the configuration
- + * data.
- + * returns: size of the buffer.
- + */
- +static ssize_t xdevcfg_show_is_partial_bitstream_status(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + ssize_t status;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + status = sprintf(buf, "%d\n", drvdata->is_partial_bitstream);
- +
- + return status;
- +}
- +
- +static DEVICE_ATTR(is_partial_bitstream, 0644,
- + xdevcfg_show_is_partial_bitstream_status,
- + xdevcfg_set_is_partial_bitstream);
- +
- +static const struct attribute *xdevcfg_attrs[] = {
- + &dev_attr_prog_done.attr, /* PCFG_DONE bit in Intr Status register */
- + &dev_attr_dbg_lock.attr, /* Debug lock bit in Lock register */
- + &dev_attr_seu_lock.attr, /* SEU lock bit in Lock register */
- + &dev_attr_aes_en_lock.attr, /* AES EN lock bit in Lock register */
- + &dev_attr_enable_aes.attr, /* AES EN bit in Control register */
- + &dev_attr_enable_seu.attr, /* SEU EN bit in Control register */
- + &dev_attr_enable_sec_dbg_nonin.attr, /*SPNIDEN bit in Control register*/
- + &dev_attr_enable_sec_dbg_in.attr, /*SPIDEN bit in Control register */
- + &dev_attr_enable_dbg_nonin.attr, /* NIDEN bit in Control register */
- + &dev_attr_enable_dbg_in.attr, /* DBGEN bit in Control register */
- + &dev_attr_enable_dap.attr, /* DAP_EN bits in Control register */
- + &dev_attr_is_partial_bitstream.attr, /* Flag for partial bitstream */
- + NULL,
- +};
- +
- +
- +static const struct attribute_group xdevcfg_attr_group = {
- + .attrs = (struct attribute **) xdevcfg_attrs,
- +};
- +
- +static ssize_t fclk_enable_show(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + struct fclk_data *pdata = dev_get_drvdata(dev);
- +
- + return scnprintf(buf, PAGE_SIZE, "%u\n", pdata->enabled);
- +}
- +
- +static ssize_t fclk_enable_store(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t count)
- +{
- + unsigned long enable;
- + int ret;
- + struct fclk_data *pdata = dev_get_drvdata(dev);
- +
- + ret = kstrtoul(buf, 0, &enable);
- + if (ret)
- + return -EINVAL;
- +
- + enable = !!enable;
- + if (enable == pdata->enabled)
- + return count;
- +
- + if (enable)
- + ret = clk_enable(pdata->clk);
- + else
- + clk_disable(pdata->clk);
- +
- + if (ret)
- + return ret;
- +
- + pdata->enabled = enable;
- + return count;
- +}
- +
- +static DEVICE_ATTR(enable, 0644, fclk_enable_show, fclk_enable_store);
- +
- +static ssize_t fclk_set_rate_show(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + struct fclk_data *pdata = dev_get_drvdata(dev);
- +
- + return scnprintf(buf, PAGE_SIZE, "%lu\n", clk_get_rate(pdata->clk));
- +}
- +
- +static ssize_t fclk_set_rate_store(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t count)
- +{
- + int ret = 0;
- + unsigned long rate;
- + struct fclk_data *pdata = dev_get_drvdata(dev);
- +
- + ret = kstrtoul(buf, 0, &rate);
- + if (ret)
- + return -EINVAL;
- +
- + rate = clk_round_rate(pdata->clk, rate);
- + ret = clk_set_rate(pdata->clk, rate);
- +
- + return ret ? ret : count;
- +}
- +
- +static DEVICE_ATTR(set_rate, 0644, fclk_set_rate_show, fclk_set_rate_store);
- +
- +static ssize_t fclk_round_rate_show(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + struct fclk_data *pdata = dev_get_drvdata(dev);
- +
- + return scnprintf(buf, PAGE_SIZE, "%lu => %lu\n", pdata->rate_rnd,
- + clk_round_rate(pdata->clk, pdata->rate_rnd));
- +}
- +
- +static ssize_t fclk_round_rate_store(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t count)
- +{
- + int ret = 0;
- + unsigned long rate;
- + struct fclk_data *pdata = dev_get_drvdata(dev);
- +
- + ret = kstrtoul(buf, 0, &rate);
- + if (ret)
- + return -EINVAL;
- +
- + pdata->rate_rnd = rate;
- +
- + return count;
- +}
- +
- +static DEVICE_ATTR(round_rate, 0644, fclk_round_rate_show,
- + fclk_round_rate_store);
- +
- +static const struct attribute *fclk_ctrl_attrs[] = {
- + &dev_attr_enable.attr,
- + &dev_attr_set_rate.attr,
- + &dev_attr_round_rate.attr,
- + NULL,
- +};
- +
- +static const struct attribute_group fclk_ctrl_attr_grp = {
- + .attrs = (struct attribute **)fclk_ctrl_attrs,
- +};
- +
- +static ssize_t xdevcfg_fclk_export_store(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t size)
- +{
- + int i, ret;
- + struct device *subdev;
- + struct fclk_data *fdata;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + for (i = 0; i < NUMFCLKS; i++) {
- + if (!strncmp(buf, fclk_name[i], strlen(fclk_name[i])))
- + break;
- + }
- +
- + if (i < NUMFCLKS && !drvdata->fclk_exported[i]) {
- + drvdata->fclk_exported[i] = 1;
- + subdev = device_create(drvdata->fclk_class, dev, MKDEV(0, 0),
- + NULL, fclk_name[i]);
- + if (IS_ERR(subdev))
- + return PTR_ERR(subdev);
- + ret = clk_prepare(drvdata->fclk[i]);
- + if (ret)
- + return ret;
- + fdata = kzalloc(sizeof(*fdata), GFP_KERNEL);
- + if (!fdata) {
- + ret = -ENOMEM;
- + goto err_unprepare;
- + }
- + fdata->clk = drvdata->fclk[i];
- + dev_set_drvdata(subdev, fdata);
- + ret = sysfs_create_group(&subdev->kobj, &fclk_ctrl_attr_grp);
- + if (ret)
- + goto err_free;
- + } else {
- + return -EINVAL;
- + }
- +
- + return size;
- +
- +err_free:
- + kfree(fdata);
- +err_unprepare:
- + clk_unprepare(drvdata->fclk[i]);
- +
- + return ret;
- +}
- +
- +static ssize_t xdevcfg_fclk_export_show(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + int i;
- + ssize_t count = 0;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + for (i = 0; i < NUMFCLKS; i++) {
- + if (!drvdata->fclk_exported[i])
- + count += scnprintf(buf + count, PAGE_SIZE - count,
- + "%s\n", fclk_name[i]);
- + }
- + return count;
- +}
- +
- +static DEVICE_ATTR(fclk_export, 0644, xdevcfg_fclk_export_show,
- + xdevcfg_fclk_export_store);
- +
- +static int match_fclk(struct device *dev, const void *data)
- +{
- + struct fclk_data *fdata = dev_get_drvdata(dev);
- +
- + return fdata->clk == data;
- +}
- +
- +static ssize_t xdevcfg_fclk_unexport_store(struct device *dev,
- + struct device_attribute *attr, const char *buf, size_t size)
- +{
- + int i;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + for (i = 0; i < NUMFCLKS; i++) {
- + if (!strncmp(buf, fclk_name[i], strlen(fclk_name[i])))
- + break;
- + }
- +
- + if (i < NUMFCLKS && drvdata->fclk_exported[i]) {
- + struct fclk_data *fdata;
- + struct device *subdev;
- +
- + drvdata->fclk_exported[i] = 0;
- + subdev = class_find_device(drvdata->fclk_class, NULL,
- + drvdata->fclk[i], match_fclk);
- + fdata = dev_get_drvdata(subdev);
- + if (fdata->enabled)
- + clk_disable(fdata->clk);
- + clk_unprepare(fdata->clk);
- + kfree(fdata);
- + device_unregister(subdev);
- + put_device(subdev);
- + } else {
- + return -EINVAL;
- + }
- +
- + return size;
- +}
- +
- +static ssize_t xdevcfg_fclk_unexport_show(struct device *dev,
- + struct device_attribute *attr, char *buf)
- +{
- + int i;
- + ssize_t count = 0;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + for (i = 0; i < NUMFCLKS; i++) {
- + if (drvdata->fclk_exported[i])
- + count += scnprintf(buf + count, PAGE_SIZE - count,
- + "%s\n", fclk_name[i]);
- + }
- + return count;
- +}
- +
- +static DEVICE_ATTR(fclk_unexport, 0644, xdevcfg_fclk_unexport_show,
- + xdevcfg_fclk_unexport_store);
- +
- +static const struct attribute *fclk_exp_attrs[] = {
- + &dev_attr_fclk_export.attr,
- + &dev_attr_fclk_unexport.attr,
- + NULL,
- +};
- +
- +static const struct attribute_group fclk_exp_attr_grp = {
- + .attrs = (struct attribute **)fclk_exp_attrs,
- +};
- +
- +static void xdevcfg_fclk_init(struct device *dev)
- +{
- + int i;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + for (i = 0; i < NUMFCLKS; i++) {
- + drvdata->fclk[i] = clk_get(dev, fclk_name[i]);
- + if (IS_ERR(drvdata->fclk[i])) {
- + dev_warn(dev, "fclk not found\n");
- + return;
- + }
- + }
- +
- + drvdata->fclk_class = class_create(THIS_MODULE, "fclk");
- + if (IS_ERR(drvdata->fclk_class)) {
- + dev_warn(dev, "failed to create fclk class\n");
- + return;
- + }
- +
- + if (sysfs_create_group(&dev->kobj, &fclk_exp_attr_grp))
- + dev_warn(dev, "failed to create sysfs entries\n");
- +}
- +
- +static void xdevcfg_fclk_remove(struct device *dev)
- +{
- + int i;
- + struct xdevcfg_drvdata *drvdata = dev_get_drvdata(dev);
- +
- + for (i = 0; i < NUMFCLKS; i++) {
- + if (drvdata->fclk_exported[i]) {
- + struct fclk_data *fdata;
- + struct device *subdev;
- +
- + drvdata->fclk_exported[i] = 0;
- + subdev = class_find_device(drvdata->fclk_class, NULL,
- + drvdata->fclk[i], match_fclk);
- + fdata = dev_get_drvdata(subdev);
- + if (fdata->enabled)
- + clk_disable(fdata->clk);
- + clk_unprepare(fdata->clk);
- + kfree(fdata);
- + device_unregister(subdev);
- + put_device(subdev);
- +
- + }
- + }
- +
- + class_destroy(drvdata->fclk_class);
- + sysfs_remove_group(&dev->kobj, &fclk_exp_attr_grp);
- +
- + return;
- +}
- +
- +/**
- + * xdevcfg_drv_probe - Probe call for the device.
- + *
- + * @pdev: handle to the platform device structure.
- + * Returns 0 on success, negative error otherwise.
- + *
- + * It does all the memory allocation and registration for the device.
- + */
- +static int xdevcfg_drv_probe(struct platform_device *pdev)
- +{
- + struct resource *res;
- + struct xdevcfg_drvdata *drvdata;
- + dev_t devt;
- + int retval;
- + u32 ctrlreg;
- + struct device_node *np;
- + const void *prop;
- + int size;
- + struct device *dev;
- +
- + drvdata = devm_kzalloc(&pdev->dev, sizeof(*drvdata), GFP_KERNEL);
- + if (!drvdata)
- + return -ENOMEM;
- +
- + res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
- + drvdata->base_address = devm_ioremap_resource(&pdev->dev, res);
- + if (IS_ERR(drvdata->base_address))
- + return PTR_ERR(drvdata->base_address);
- +
- + drvdata->irq = platform_get_irq(pdev, 0);
- + retval = devm_request_irq(&pdev->dev, drvdata->irq, &xdevcfg_irq,
- + 0, dev_name(&pdev->dev), drvdata);
- + if (retval) {
- + dev_err(&pdev->dev, "No IRQ available");
- + return retval;
- + }
- +
- + platform_set_drvdata(pdev, drvdata);
- + spin_lock_init(&drvdata->lock);
- + mutex_init(&drvdata->sem);
- + drvdata->is_open = 0;
- + drvdata->is_partial_bitstream = 0;
- + drvdata->dma_done = 0;
- + drvdata->error_status = 0;
- + dev_info(&pdev->dev, "ioremap %pa to %p\n",
- + &res->start, drvdata->base_address);
- +
- + drvdata->clk = devm_clk_get(&pdev->dev, "ref_clk");
- + if (IS_ERR(drvdata->clk)) {
- + dev_err(&pdev->dev, "input clock not found\n");
- + return PTR_ERR(drvdata->clk);
- + }
- +
- + retval = clk_prepare_enable(drvdata->clk);
- + if (retval) {
- + dev_err(&pdev->dev, "unable to enable clock\n");
- + return retval;
- + }
- +
- + /*
- + * Figure out from the device tree if this is running on the EP107
- + * emulation platform as it doesn't match the silicon exactly and the
- + * driver needs to work accordingly.
- + */
- + np = of_get_next_parent(pdev->dev.of_node);
- + np = of_get_next_parent(np);
- + prop = of_get_property(np, "compatible", &size);
- +
- + if (prop != NULL) {
- + if ((strcmp((const char *)prop, "xlnx,zynq-ep107")) == 0)
- + drvdata->ep107 = 1;
- + else
- + drvdata->ep107 = 0;
- + }
- +
- + /* Unlock the device */
- + xdevcfg_writereg(drvdata->base_address + XDCFG_UNLOCK_OFFSET,
- + 0x757BDF0D);
- +
- + /*
- + * Set the configuration register with the following options
- + * - Reset FPGA
- + * - Enable the PCAP interface
- + * - Set the throughput rate for maximum speed
- + * - Set the CPU in user mode
- + */
- + ctrlreg = xdevcfg_readreg(drvdata->base_address + XDCFG_CTRL_OFFSET);
- + ctrlreg &= ~XDCFG_CTRL_PCAP_PR_MASK;
- + ctrlreg |= XDCFG_CTRL_PCFG_PROG_B_MASK | XDCFG_CTRL_PCAP_MODE_MASK;
- + xdevcfg_writereg(drvdata->base_address + XDCFG_CTRL_OFFSET, ctrlreg);
- +
- + /* Ensure internal PCAP loopback is disabled */
- + ctrlreg = xdevcfg_readreg(drvdata->base_address + XDCFG_MCTRL_OFFSET);
- + xdevcfg_writereg(drvdata->base_address + XDCFG_MCTRL_OFFSET,
- + (~XDCFG_MCTRL_PCAP_LPBK_MASK &
- + ctrlreg));
- +
- +
- + retval = alloc_chrdev_region(&devt, 0, XDEVCFG_DEVICES, DRIVER_NAME);
- + if (retval < 0)
- + goto failed5;
- +
- + drvdata->devt = devt;
- +
- + cdev_init(&drvdata->cdev, &xdevcfg_fops);
- + drvdata->cdev.owner = THIS_MODULE;
- + retval = cdev_add(&drvdata->cdev, devt, 1);
- + if (retval) {
- + dev_err(&pdev->dev, "cdev_add() failed\n");
- + goto failed6;
- + }
- +
- + drvdata->class = class_create(THIS_MODULE, DRIVER_NAME);
- + if (IS_ERR(drvdata->class)) {
- + dev_err(&pdev->dev, "failed to create class\n");
- + goto failed6;
- + }
- +
- + dev = device_create(drvdata->class, &pdev->dev, devt, drvdata,
- + DRIVER_NAME);
- + if (IS_ERR(dev)) {
- + dev_err(&pdev->dev, "unable to create device\n");
- + goto failed7;
- + }
- +
- + /* create sysfs files for the device */
- + retval = sysfs_create_group(&(pdev->dev.kobj), &xdevcfg_attr_group);
- + if (retval) {
- + dev_err(&pdev->dev, "Failed to create sysfs attr group\n");
- + cdev_del(&drvdata->cdev);
- + goto failed8;
- + }
- +
- + xdevcfg_fclk_init(&pdev->dev);
- +
- + clk_disable(drvdata->clk);
- +
- + return 0; /* Success */
- +
- +failed8:
- + device_destroy(drvdata->class, drvdata->devt);
- +failed7:
- + class_destroy(drvdata->class);
- +failed6:
- + /* Unregister char driver */
- + unregister_chrdev_region(devt, XDEVCFG_DEVICES);
- +failed5:
- + clk_disable_unprepare(drvdata->clk);
- +
- + return retval;
- +}
- +
- +/**
- + * xdevcfg_drv_remove - Remove call for the device.
- + *
- + * @pdev: handle to the platform device structure.
- + * Returns 0 or error status.
- + *
- + * Unregister the device after releasing the resources.
- + */
- +static int xdevcfg_drv_remove(struct platform_device *pdev)
- +{
- + struct xdevcfg_drvdata *drvdata;
- +
- + drvdata = platform_get_drvdata(pdev);
- +
- + if (!drvdata)
- + return -ENODEV;
- +
- + unregister_chrdev_region(drvdata->devt, XDEVCFG_DEVICES);
- +
- + sysfs_remove_group(&pdev->dev.kobj, &xdevcfg_attr_group);
- +
- + xdevcfg_fclk_remove(&pdev->dev);
- + device_destroy(drvdata->class, drvdata->devt);
- + class_destroy(drvdata->class);
- + cdev_del(&drvdata->cdev);
- + clk_unprepare(drvdata->clk);
- +
- + return 0; /* Success */
- +}
- +
- +static struct of_device_id xdevcfg_of_match[] = {
- + { .compatible = "xlnx,zynq-devcfg-1.0", },
- + { /* end of table */}
- +};
- +MODULE_DEVICE_TABLE(of, xdevcfg_of_match);
- +
- +/* Driver Structure */
- +static struct platform_driver xdevcfg_platform_driver = {
- + .probe = xdevcfg_drv_probe,
- + .remove = xdevcfg_drv_remove,
- + .driver = {
- + .owner = THIS_MODULE,
- + .name = DRIVER_NAME,
- + .of_match_table = xdevcfg_of_match,
- + },
- +};
- +
- +module_platform_driver(xdevcfg_platform_driver);
- +
- +MODULE_AUTHOR("Xilinx, Inc");
- +MODULE_DESCRIPTION("Xilinx Device Config Driver");
- +MODULE_LICENSE("GPL");
- --- a/arch/arm/mach-zynq/common.h
- +++ b/arch/arm/mach-zynq/common.h
- @@ -33,6 +33,9 @@ extern int zynq_cpun_start(u32 address,
- extern struct smp_operations zynq_smp_ops __initdata;
- #endif
-
- +extern void zynq_slcr_init_preload_fpga(void);
- +extern void zynq_slcr_init_postload_fpga(void);
- +
- extern void __iomem *zynq_scu_base;
-
- void zynq_pm_late_init(void);
- --- a/arch/arm/mach-zynq/slcr.c
- +++ b/arch/arm/mach-zynq/slcr.c
- @@ -24,10 +24,14 @@
-
- /* register offsets */
- #define SLCR_UNLOCK_OFFSET 0x8 /* SCLR unlock register */
- +
- #define SLCR_PS_RST_CTRL_OFFSET 0x200 /* PS Software Reset Control */
- +#define SLCR_FPGA_RST_CTRL_OFFSET 0x240 /* FPGA Software Reset Control */
- #define SLCR_A9_CPU_RST_CTRL_OFFSET 0x244 /* CPU Software Reset Control */
- #define SLCR_REBOOT_STATUS_OFFSET 0x258 /* PS Reboot Status */
- #define SLCR_PSS_IDCODE 0x530 /* PS IDCODE */
- +#define SLCR_L2C_RAM 0xA1C /* L2C_RAM in AR#54190 */
- +#define SLCR_LVL_SHFTR_EN_OFFSET 0x900 /* Level Shifters Enable */
-
- #define SLCR_UNLOCK_MAGIC 0xDF0D
- #define SLCR_A9_CPU_CLKSTOP 0x10
- @@ -124,6 +128,35 @@ static struct notifier_block zynq_slcr_r
- };
-
- /**
- + * zynq_slcr_init_preload_fpga - Disable communication from the PL to PS.
- + */
- +void zynq_slcr_init_preload_fpga(void)
- +{
- + /* Assert FPGA top level output resets */
- + zynq_slcr_write(0xF, SLCR_FPGA_RST_CTRL_OFFSET);
- +
- + /* Disable level shifters */
- + zynq_slcr_write(0, SLCR_LVL_SHFTR_EN_OFFSET);
- +
- + /* Enable output level shifters */
- + zynq_slcr_write(0xA, SLCR_LVL_SHFTR_EN_OFFSET);
- +}
- +EXPORT_SYMBOL(zynq_slcr_init_preload_fpga);
- +
- +/**
- + * zynq_slcr_init_postload_fpga - Re-enable communication from the PL to PS.
- + */
- +void zynq_slcr_init_postload_fpga(void)
- +{
- + /* Enable level shifters */
- + zynq_slcr_write(0xf, SLCR_LVL_SHFTR_EN_OFFSET);
- +
- + /* Deassert AXI interface resets */
- + zynq_slcr_write(0, SLCR_FPGA_RST_CTRL_OFFSET);
- +}
- +EXPORT_SYMBOL(zynq_slcr_init_postload_fpga);
- +
- +/**
- * zynq_slcr_cpu_start - Start cpu
- * @cpu: cpu number
- */
- @@ -227,6 +260,9 @@ int __init zynq_early_slcr_init(void)
- /* unlock the SLCR so that registers can be changed */
- zynq_slcr_unlock();
-
- + /* See AR#54190 design advisory */
- + regmap_update_bits(zynq_slcr_regmap, SLCR_L2C_RAM, 0x70707, 0x20202);
- +
- register_restart_handler(&zynq_slcr_restart_nb);
-
- pr_info("%s mapped to %p\n", np->name, zynq_slcr_base);
- --- a/arch/arm/boot/dts/zynq-7000.dtsi
- +++ b/arch/arm/boot/dts/zynq-7000.dtsi
- @@ -244,7 +244,7 @@
- clkc: clkc@100 {
- #clock-cells = <1>;
- compatible = "xlnx,ps7-clkc";
- - fclk-enable = <0>;
- + fclk-enable = <0xf>;
- clock-output-names = "armpll", "ddrpll", "iopll", "cpu_6or4x",
- "cpu_3or2x", "cpu_2x", "cpu_1x", "ddr2x", "ddr3x",
- "dci", "lqspi", "smc", "pcap", "gem0", "gem1",
- @@ -296,8 +296,8 @@
- reg = <0xf8007000 0x100>;
- interrupt-parent = <&intc>;
- interrupts = <0 8 4>;
- - clocks = <&clkc 12>;
- - clock-names = "ref_clk";
- + clocks = <&clkc 12>, <&clkc 15>, <&clkc 16>, <&clkc 17>, <&clkc 18>;
- + clock-names = "ref_clk", "fclk0", "fclk1", "fclk2", "fclk3";
- syscon = <&slcr>;
- };
-
|