131 	struct aspeed_lpc_snoop *lpc_snoop = arg;  in aspeed_lpc_snoop_irq()  local
134 	if (regmap_read(lpc_snoop->regmap, HICR6, &reg))  in aspeed_lpc_snoop_irq()
143 	regmap_write(lpc_snoop->regmap, HICR6, reg);  in aspeed_lpc_snoop_irq()
146 	regmap_read(lpc_snoop->regmap, SNPWDR, &data);  in aspeed_lpc_snoop_irq()
151 		put_fifo_with_discard(&lpc_snoop->chan[0], val);  in aspeed_lpc_snoop_irq()
156 		put_fifo_with_discard(&lpc_snoop->chan[1], val);  in aspeed_lpc_snoop_irq()
162 static int aspeed_lpc_snoop_config_irq(struct aspeed_lpc_snoop *lpc_snoop,  in aspeed_lpc_snoop_config_irq()  argument
168 	lpc_snoop->irq = platform_get_irq(pdev, 0);  in aspeed_lpc_snoop_config_irq()
169 	if (!lpc_snoop->irq)  in aspeed_lpc_snoop_config_irq()
172 	rc = devm_request_irq(dev, lpc_snoop->irq,  in aspeed_lpc_snoop_config_irq()
174 			      DEVICE_NAME, lpc_snoop);  in aspeed_lpc_snoop_config_irq()
176 		dev_warn(dev, "Unable to request IRQ %d\n", lpc_snoop->irq);  in aspeed_lpc_snoop_config_irq()
177 		lpc_snoop->irq = 0;  in aspeed_lpc_snoop_config_irq()
184 static int aspeed_lpc_enable_snoop(struct aspeed_lpc_snoop *lpc_snoop,  in aspeed_lpc_enable_snoop()  argument
193 	init_waitqueue_head(&lpc_snoop->chan[channel].wq);  in aspeed_lpc_enable_snoop()
195 	rc = kfifo_alloc(&lpc_snoop->chan[channel].fifo,  in aspeed_lpc_enable_snoop()
200 	lpc_snoop->chan[channel].miscdev.minor = MISC_DYNAMIC_MINOR;  in aspeed_lpc_enable_snoop()
201 	lpc_snoop->chan[channel].miscdev.name =  in aspeed_lpc_enable_snoop()
203 	if (!lpc_snoop->chan[channel].miscdev.name) {  in aspeed_lpc_enable_snoop()
207 	lpc_snoop->chan[channel].miscdev.fops = &snoop_fops;  in aspeed_lpc_enable_snoop()
208 	lpc_snoop->chan[channel].miscdev.parent = dev;  in aspeed_lpc_enable_snoop()
209 	rc = misc_register(&lpc_snoop->chan[channel].miscdev);  in aspeed_lpc_enable_snoop()
232 	regmap_update_bits(lpc_snoop->regmap, HICR5, hicr5_en, hicr5_en);  in aspeed_lpc_enable_snoop()
233 	regmap_update_bits(lpc_snoop->regmap, SNPWADR, snpwadr_mask,  in aspeed_lpc_enable_snoop()
236 		regmap_update_bits(lpc_snoop->regmap, HICRB,  in aspeed_lpc_enable_snoop()
242 	misc_deregister(&lpc_snoop->chan[channel].miscdev);  in aspeed_lpc_enable_snoop()
244 	kfifo_free(&lpc_snoop->chan[channel].fifo);  in aspeed_lpc_enable_snoop()
248 static void aspeed_lpc_disable_snoop(struct aspeed_lpc_snoop *lpc_snoop,  in aspeed_lpc_disable_snoop()  argument
253 		regmap_update_bits(lpc_snoop->regmap, HICR5,  in aspeed_lpc_disable_snoop()
258 		regmap_update_bits(lpc_snoop->regmap, HICR5,  in aspeed_lpc_disable_snoop()
266 	kfifo_free(&lpc_snoop->chan[channel].fifo);  in aspeed_lpc_disable_snoop()
267 	misc_deregister(&lpc_snoop->chan[channel].miscdev);  in aspeed_lpc_disable_snoop()
272 	struct aspeed_lpc_snoop *lpc_snoop;  in aspeed_lpc_snoop_probe()  local
280 	lpc_snoop = devm_kzalloc(dev, sizeof(*lpc_snoop), GFP_KERNEL);  in aspeed_lpc_snoop_probe()
281 	if (!lpc_snoop)  in aspeed_lpc_snoop_probe()
292 	lpc_snoop->regmap = syscon_node_to_regmap(np);  in aspeed_lpc_snoop_probe()
293 	if (IS_ERR(lpc_snoop->regmap)) {  in aspeed_lpc_snoop_probe()
298 	dev_set_drvdata(&pdev->dev, lpc_snoop);  in aspeed_lpc_snoop_probe()
306 	lpc_snoop->clk = devm_clk_get(dev, NULL);  in aspeed_lpc_snoop_probe()
307 	if (IS_ERR(lpc_snoop->clk)) {  in aspeed_lpc_snoop_probe()
308 		rc = PTR_ERR(lpc_snoop->clk);  in aspeed_lpc_snoop_probe()
313 	rc = clk_prepare_enable(lpc_snoop->clk);  in aspeed_lpc_snoop_probe()
319 	rc = aspeed_lpc_snoop_config_irq(lpc_snoop, pdev);  in aspeed_lpc_snoop_probe()
323 	rc = aspeed_lpc_enable_snoop(lpc_snoop, dev, 0, port);  in aspeed_lpc_snoop_probe()
330 		rc = aspeed_lpc_enable_snoop(lpc_snoop, dev, 1, port);  in aspeed_lpc_snoop_probe()
332 			aspeed_lpc_disable_snoop(lpc_snoop, 0);  in aspeed_lpc_snoop_probe()
340 	clk_disable_unprepare(lpc_snoop->clk);  in aspeed_lpc_snoop_probe()
347 	struct aspeed_lpc_snoop *lpc_snoop = dev_get_drvdata(&pdev->dev);  in aspeed_lpc_snoop_remove()  local
350 	aspeed_lpc_disable_snoop(lpc_snoop, 0);  in aspeed_lpc_snoop_remove()
351 	aspeed_lpc_disable_snoop(lpc_snoop, 1);  in aspeed_lpc_snoop_remove()
353 	clk_disable_unprepare(lpc_snoop->clk);  in aspeed_lpc_snoop_remove()