imx: sip: add call_imx_sip_ret2
This function will be used by i.MX8 fuse driver. Signed-off-by: Peng Fan <peng.fan@nxp.com>
This commit is contained in:
		
							parent
							
								
									3fbd2dce35
								
							
						
					
					
						commit
						a87eb0405f
					
				| 
						 | 
				
			
			@ -134,4 +134,7 @@ int mxs_wait_mask_clr(struct mxs_register_32 *reg, u32 mask, u32 timeout);
 | 
			
		|||
 | 
			
		||||
unsigned long call_imx_sip(unsigned long id, unsigned long reg0,
 | 
			
		||||
			   unsigned long reg1, unsigned long reg2);
 | 
			
		||||
unsigned long call_imx_sip_ret2(unsigned long id, unsigned long reg0,
 | 
			
		||||
				unsigned long *reg1, unsigned long reg2,
 | 
			
		||||
				unsigned long reg3);
 | 
			
		||||
#endif
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -20,3 +20,25 @@ unsigned long call_imx_sip(unsigned long id, unsigned long reg0,
 | 
			
		|||
 | 
			
		||||
	return regs.regs[0];
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/*
 | 
			
		||||
 * Do an SMC call to return 2 registers by having reg1 passed in by reference
 | 
			
		||||
 */
 | 
			
		||||
unsigned long call_imx_sip_ret2(unsigned long id, unsigned long reg0,
 | 
			
		||||
				unsigned long *reg1, unsigned long reg2,
 | 
			
		||||
				unsigned long reg3)
 | 
			
		||||
{
 | 
			
		||||
	struct pt_regs regs;
 | 
			
		||||
 | 
			
		||||
	regs.regs[0] = id;
 | 
			
		||||
	regs.regs[1] = reg0;
 | 
			
		||||
	regs.regs[2] = *reg1;
 | 
			
		||||
	regs.regs[3] = reg2;
 | 
			
		||||
	regs.regs[4] = reg3;
 | 
			
		||||
 | 
			
		||||
	smc_call(®s);
 | 
			
		||||
 | 
			
		||||
	*reg1 = regs.regs[1];
 | 
			
		||||
 | 
			
		||||
	return regs.regs[0];
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
		Loading…
	
		Reference in New Issue