65 lines
		
	
	
	
		
			2.2 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			65 lines
		
	
	
	
		
			2.2 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
|   | /*
 | ||
|  |  * Copyright (c) 2009 QLogic Corporation. All rights reserved. | ||
|  |  * | ||
|  |  * This software is available to you under a choice of one of two | ||
|  |  * licenses.  You may choose to be licensed under the terms of the GNU | ||
|  |  * General Public License (GPL) Version 2, available from the file | ||
|  |  * COPYING in the main directory of this source tree, or the | ||
|  |  * OpenIB.org BSD license below: | ||
|  |  * | ||
|  |  *     Redistribution and use in source and binary forms, with or | ||
|  |  *     without modification, are permitted provided that the following | ||
|  |  *     conditions are met: | ||
|  |  * | ||
|  |  *      - Redistributions of source code must retain the above | ||
|  |  *        copyright notice, this list of conditions and the following | ||
|  |  *        disclaimer. | ||
|  |  * | ||
|  |  *      - Redistributions in binary form must reproduce the above | ||
|  |  *        copyright notice, this list of conditions and the following | ||
|  |  *        disclaimer in the documentation and/or other materials | ||
|  |  *        provided with the distribution. | ||
|  |  * | ||
|  |  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | ||
|  |  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | ||
|  |  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | ||
|  |  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | ||
|  |  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
|  |  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | ||
|  |  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | ||
|  |  * SOFTWARE. | ||
|  |  */ | ||
|  | 
 | ||
|  | #include "qib.h"
 | ||
|  | 
 | ||
|  | /**
 | ||
|  |  * qib_pio_copy - copy data to MMIO space, in multiples of 32-bits | ||
|  |  * @to: destination, in MMIO space (must be 64-bit aligned) | ||
|  |  * @from: source (must be 64-bit aligned) | ||
|  |  * @count: number of 32-bit quantities to copy | ||
|  |  * | ||
|  |  * Copy data from kernel space to MMIO space, in multiples of 32 bits at a | ||
|  |  * time.  Order of access is not guaranteed, nor is a memory barrier | ||
|  |  * performed afterwards. | ||
|  |  */ | ||
|  | void qib_pio_copy(void __iomem *to, const void *from, size_t count) | ||
|  | { | ||
|  | #ifdef CONFIG_64BIT
 | ||
|  | 	u64 __iomem *dst = to; | ||
|  | 	const u64 *src = from; | ||
|  | 	const u64 *end = src + (count >> 1); | ||
|  | 
 | ||
|  | 	while (src < end) | ||
|  | 		__raw_writeq(*src++, dst++); | ||
|  | 	if (count & 1) | ||
|  | 		__raw_writel(*(const u32 *)src, dst); | ||
|  | #else
 | ||
|  | 	u32 __iomem *dst = to; | ||
|  | 	const u32 *src = from; | ||
|  | 	const u32 *end = src + count; | ||
|  | 
 | ||
|  | 	while (src < end) | ||
|  | 		__raw_writel(*src++, dst++); | ||
|  | #endif
 | ||
|  | } |