hc
2023-03-21 4b55d97acc464242bcd6a8ae77b8ff37c22dec58
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
// SPDX-License-Identifier: GPL-2.0
/* Copyright (C) 2012-2018 ARM Limited or its affiliates. */
 
#include <linux/kernel.h>
#include <linux/interrupt.h>
#include <linux/pm_runtime.h>
#include "cc_driver.h"
#include "cc_buffer_mgr.h"
#include "cc_request_mgr.h"
#include "cc_sram_mgr.h"
#include "cc_ivgen.h"
#include "cc_hash.h"
#include "cc_pm.h"
#include "cc_fips.h"
 
#define POWER_DOWN_ENABLE 0x01
#define POWER_DOWN_DISABLE 0x00
 
const struct dev_pm_ops ccree_pm = {
   SET_RUNTIME_PM_OPS(cc_pm_suspend, cc_pm_resume, NULL)
};
 
int cc_pm_suspend(struct device *dev)
{
   struct cc_drvdata *drvdata = dev_get_drvdata(dev);
 
   dev_dbg(dev, "set HOST_POWER_DOWN_EN\n");
   fini_cc_regs(drvdata);
   cc_iowrite(drvdata, CC_REG(HOST_POWER_DOWN_EN), POWER_DOWN_ENABLE);
   cc_clk_off(drvdata);
   return 0;
}
 
int cc_pm_resume(struct device *dev)
{
   int rc;
   struct cc_drvdata *drvdata = dev_get_drvdata(dev);
 
   dev_dbg(dev, "unset HOST_POWER_DOWN_EN\n");
   /* Enables the device source clk */
   rc = cc_clk_on(drvdata);
   if (rc) {
       dev_err(dev, "failed getting clock back on. We're toast.\n");
       return rc;
   }
 
   cc_iowrite(drvdata, CC_REG(HOST_POWER_DOWN_EN), POWER_DOWN_DISABLE);
   rc = init_cc_regs(drvdata, false);
   if (rc) {
       dev_err(dev, "init_cc_regs (%x)\n", rc);
       return rc;
   }
   /* check if tee fips error occurred during power down */
   cc_tee_handle_fips_error(drvdata);
 
   cc_init_hash_sram(drvdata);
 
   cc_init_iv_sram(drvdata);
   return 0;
}
 
int cc_pm_get(struct device *dev)
{
   int rc = 0;
   struct cc_drvdata *drvdata = dev_get_drvdata(dev);
 
   if (drvdata->pm_on)
       rc = pm_runtime_get_sync(dev);
 
   return (rc == 1 ? 0 : rc);
}
 
int cc_pm_put_suspend(struct device *dev)
{
   int rc = 0;
   struct cc_drvdata *drvdata = dev_get_drvdata(dev);
 
   if (drvdata->pm_on) {
       pm_runtime_mark_last_busy(dev);
       rc = pm_runtime_put_autosuspend(dev);
   }
 
   return rc;
}
 
int cc_pm_init(struct cc_drvdata *drvdata)
{
   struct device *dev = drvdata_to_dev(drvdata);
 
   /* must be before the enabling to avoid resdundent suspending */
   pm_runtime_set_autosuspend_delay(dev, CC_SUSPEND_TIMEOUT);
   pm_runtime_use_autosuspend(dev);
   /* set us as active - note we won't do PM ops until cc_pm_go()! */
   return pm_runtime_set_active(dev);
}
 
/* enable the PM module*/
void cc_pm_go(struct cc_drvdata *drvdata)
{
   pm_runtime_enable(drvdata_to_dev(drvdata));
   drvdata->pm_on = true;
}
 
void cc_pm_fini(struct cc_drvdata *drvdata)
{
   pm_runtime_disable(drvdata_to_dev(drvdata));
   drvdata->pm_on = false;
}