@@ -26,34 +26,6 @@ static const struct spi_device_id cs35l41_id_spi[] = {
2626
2727MODULE_DEVICE_TABLE (spi , cs35l41_id_spi );
2828
29- static void cs35l41_spi_otp_setup (struct cs35l41_private * cs35l41 ,
30- bool is_pre_setup , unsigned int * freq )
31- {
32- struct spi_device * spi ;
33- u32 orig_spi_freq ;
34-
35- spi = to_spi_device (cs35l41 -> dev );
36-
37- if (!spi ) {
38- dev_err (cs35l41 -> dev , "%s: No SPI device\n" , __func__ );
39- return ;
40- }
41-
42- if (is_pre_setup ) {
43- orig_spi_freq = spi -> max_speed_hz ;
44- if (orig_spi_freq > CS35L41_SPI_MAX_FREQ_OTP ) {
45- spi -> max_speed_hz = CS35L41_SPI_MAX_FREQ_OTP ;
46- spi_setup (spi );
47- }
48- * freq = orig_spi_freq ;
49- } else {
50- if (spi -> max_speed_hz != * freq ) {
51- spi -> max_speed_hz = * freq ;
52- spi_setup (spi );
53- }
54- }
55- }
56-
5729static int cs35l41_spi_probe (struct spi_device * spi )
5830{
5931 const struct regmap_config * regmap_config = & cs35l41_regmap_spi ;
@@ -65,6 +37,9 @@ static int cs35l41_spi_probe(struct spi_device *spi)
6537 if (!cs35l41 )
6638 return - ENOMEM ;
6739
40+ spi -> max_speed_hz = CS35L41_SPI_MAX_FREQ ;
41+ spi_setup (spi );
42+
6843 spi_set_drvdata (spi , cs35l41 );
6944 cs35l41 -> regmap = devm_regmap_init_spi (spi , regmap_config );
7045 if (IS_ERR (cs35l41 -> regmap )) {
@@ -75,7 +50,6 @@ static int cs35l41_spi_probe(struct spi_device *spi)
7550
7651 cs35l41 -> dev = & spi -> dev ;
7752 cs35l41 -> irq = spi -> irq ;
78- cs35l41 -> otp_setup = cs35l41_spi_otp_setup ;
7953
8054 return cs35l41_probe (cs35l41 , pdata );
8155}
0 commit comments