| .. | .. |
|---|
| 1 | +// SPDX-License-Identifier: GPL-2.0-only |
|---|
| 1 | 2 | /* |
|---|
| 2 | 3 | * Micro Crystal RV-3029 / RV-3049 rtc class driver |
|---|
| 3 | 4 | * |
|---|
| .. | .. |
|---|
| 5 | 6 | * Michael Buesch <m@bues.ch> |
|---|
| 6 | 7 | * |
|---|
| 7 | 8 | * based on previously existing rtc class drivers |
|---|
| 8 | | - * |
|---|
| 9 | | - * This program is free software; you can redistribute it and/or modify |
|---|
| 10 | | - * it under the terms of the GNU General Public License version 2 as |
|---|
| 11 | | - * published by the Free Software Foundation. |
|---|
| 12 | | - * |
|---|
| 13 | 9 | */ |
|---|
| 14 | 10 | |
|---|
| 15 | 11 | #include <linux/module.h> |
|---|
| .. | .. |
|---|
| 113 | 109 | #define RV3029_CONTROL_E2P_TOV_MASK 0x3F /* XTAL turnover temp mask */ |
|---|
| 114 | 110 | |
|---|
| 115 | 111 | /* user ram section */ |
|---|
| 116 | | -#define RV3029_USR1_RAM_PAGE 0x38 |
|---|
| 117 | | -#define RV3029_USR1_SECTION_LEN 0x04 |
|---|
| 118 | | -#define RV3029_USR2_RAM_PAGE 0x3C |
|---|
| 119 | | -#define RV3029_USR2_SECTION_LEN 0x04 |
|---|
| 112 | +#define RV3029_RAM_PAGE 0x38 |
|---|
| 113 | +#define RV3029_RAM_SECTION_LEN 8 |
|---|
| 120 | 114 | |
|---|
| 121 | 115 | struct rv3029_data { |
|---|
| 122 | 116 | struct device *dev; |
|---|
| .. | .. |
|---|
| 125 | 119 | int irq; |
|---|
| 126 | 120 | }; |
|---|
| 127 | 121 | |
|---|
| 128 | | -static int rv3029_read_regs(struct device *dev, u8 reg, u8 *buf, |
|---|
| 129 | | - unsigned int len) |
|---|
| 122 | +static int rv3029_eeprom_busywait(struct rv3029_data *rv3029) |
|---|
| 130 | 123 | { |
|---|
| 131 | | - struct rv3029_data *rv3029 = dev_get_drvdata(dev); |
|---|
| 132 | | - |
|---|
| 133 | | - if ((reg > RV3029_USR1_RAM_PAGE + 7) || |
|---|
| 134 | | - (reg + len > RV3029_USR1_RAM_PAGE + 8)) |
|---|
| 135 | | - return -EINVAL; |
|---|
| 136 | | - |
|---|
| 137 | | - return regmap_bulk_read(rv3029->regmap, reg, buf, len); |
|---|
| 138 | | -} |
|---|
| 139 | | - |
|---|
| 140 | | -static int rv3029_write_regs(struct device *dev, u8 reg, u8 const buf[], |
|---|
| 141 | | - unsigned int len) |
|---|
| 142 | | -{ |
|---|
| 143 | | - struct rv3029_data *rv3029 = dev_get_drvdata(dev); |
|---|
| 144 | | - |
|---|
| 145 | | - if ((reg > RV3029_USR1_RAM_PAGE + 7) || |
|---|
| 146 | | - (reg + len > RV3029_USR1_RAM_PAGE + 8)) |
|---|
| 147 | | - return -EINVAL; |
|---|
| 148 | | - |
|---|
| 149 | | - return regmap_bulk_write(rv3029->regmap, reg, buf, len); |
|---|
| 150 | | -} |
|---|
| 151 | | - |
|---|
| 152 | | -static int rv3029_update_bits(struct device *dev, u8 reg, u8 mask, u8 set) |
|---|
| 153 | | -{ |
|---|
| 154 | | - u8 buf; |
|---|
| 155 | | - int ret; |
|---|
| 156 | | - |
|---|
| 157 | | - ret = rv3029_read_regs(dev, reg, &buf, 1); |
|---|
| 158 | | - if (ret < 0) |
|---|
| 159 | | - return ret; |
|---|
| 160 | | - buf &= ~mask; |
|---|
| 161 | | - buf |= set & mask; |
|---|
| 162 | | - ret = rv3029_write_regs(dev, reg, &buf, 1); |
|---|
| 163 | | - if (ret < 0) |
|---|
| 164 | | - return ret; |
|---|
| 165 | | - |
|---|
| 166 | | - return 0; |
|---|
| 167 | | -} |
|---|
| 168 | | - |
|---|
| 169 | | -static int rv3029_get_sr(struct device *dev, u8 *buf) |
|---|
| 170 | | -{ |
|---|
| 171 | | - int ret = rv3029_read_regs(dev, RV3029_STATUS, buf, 1); |
|---|
| 172 | | - |
|---|
| 173 | | - if (ret < 0) |
|---|
| 174 | | - return -EIO; |
|---|
| 175 | | - dev_dbg(dev, "status = 0x%.2x (%d)\n", buf[0], buf[0]); |
|---|
| 176 | | - return 0; |
|---|
| 177 | | -} |
|---|
| 178 | | - |
|---|
| 179 | | -static int rv3029_set_sr(struct device *dev, u8 val) |
|---|
| 180 | | -{ |
|---|
| 181 | | - u8 buf[1]; |
|---|
| 182 | | - int sr; |
|---|
| 183 | | - |
|---|
| 184 | | - buf[0] = val; |
|---|
| 185 | | - sr = rv3029_write_regs(dev, RV3029_STATUS, buf, 1); |
|---|
| 186 | | - dev_dbg(dev, "status = 0x%.2x (%d)\n", buf[0], buf[0]); |
|---|
| 187 | | - if (sr < 0) |
|---|
| 188 | | - return -EIO; |
|---|
| 189 | | - return 0; |
|---|
| 190 | | -} |
|---|
| 191 | | - |
|---|
| 192 | | -static int rv3029_eeprom_busywait(struct device *dev) |
|---|
| 193 | | -{ |
|---|
| 124 | + unsigned int sr; |
|---|
| 194 | 125 | int i, ret; |
|---|
| 195 | | - u8 sr; |
|---|
| 196 | 126 | |
|---|
| 197 | 127 | for (i = 100; i > 0; i--) { |
|---|
| 198 | | - ret = rv3029_get_sr(dev, &sr); |
|---|
| 128 | + ret = regmap_read(rv3029->regmap, RV3029_STATUS, &sr); |
|---|
| 199 | 129 | if (ret < 0) |
|---|
| 200 | 130 | break; |
|---|
| 201 | 131 | if (!(sr & RV3029_STATUS_EEBUSY)) |
|---|
| .. | .. |
|---|
| 203 | 133 | usleep_range(1000, 10000); |
|---|
| 204 | 134 | } |
|---|
| 205 | 135 | if (i <= 0) { |
|---|
| 206 | | - dev_err(dev, "EEPROM busy wait timeout.\n"); |
|---|
| 136 | + dev_err(rv3029->dev, "EEPROM busy wait timeout.\n"); |
|---|
| 207 | 137 | return -ETIMEDOUT; |
|---|
| 208 | 138 | } |
|---|
| 209 | 139 | |
|---|
| 210 | 140 | return ret; |
|---|
| 211 | 141 | } |
|---|
| 212 | 142 | |
|---|
| 213 | | -static int rv3029_eeprom_exit(struct device *dev) |
|---|
| 143 | +static int rv3029_eeprom_exit(struct rv3029_data *rv3029) |
|---|
| 214 | 144 | { |
|---|
| 215 | 145 | /* Re-enable eeprom refresh */ |
|---|
| 216 | | - return rv3029_update_bits(dev, RV3029_ONOFF_CTRL, |
|---|
| 146 | + return regmap_update_bits(rv3029->regmap, RV3029_ONOFF_CTRL, |
|---|
| 217 | 147 | RV3029_ONOFF_CTRL_EERE, |
|---|
| 218 | 148 | RV3029_ONOFF_CTRL_EERE); |
|---|
| 219 | 149 | } |
|---|
| 220 | 150 | |
|---|
| 221 | | -static int rv3029_eeprom_enter(struct device *dev) |
|---|
| 151 | +static int rv3029_eeprom_enter(struct rv3029_data *rv3029) |
|---|
| 222 | 152 | { |
|---|
| 153 | + unsigned int sr; |
|---|
| 223 | 154 | int ret; |
|---|
| 224 | | - u8 sr; |
|---|
| 225 | 155 | |
|---|
| 226 | 156 | /* Check whether we are in the allowed voltage range. */ |
|---|
| 227 | | - ret = rv3029_get_sr(dev, &sr); |
|---|
| 157 | + ret = regmap_read(rv3029->regmap, RV3029_STATUS, &sr); |
|---|
| 228 | 158 | if (ret < 0) |
|---|
| 229 | 159 | return ret; |
|---|
| 230 | | - if (sr & (RV3029_STATUS_VLOW1 | RV3029_STATUS_VLOW2)) { |
|---|
| 160 | + if (sr & RV3029_STATUS_VLOW2) |
|---|
| 161 | + return -ENODEV; |
|---|
| 162 | + if (sr & RV3029_STATUS_VLOW1) { |
|---|
| 231 | 163 | /* We clear the bits and retry once just in case |
|---|
| 232 | 164 | * we had a brown out in early startup. |
|---|
| 233 | 165 | */ |
|---|
| 234 | | - sr &= ~RV3029_STATUS_VLOW1; |
|---|
| 235 | | - sr &= ~RV3029_STATUS_VLOW2; |
|---|
| 236 | | - ret = rv3029_set_sr(dev, sr); |
|---|
| 166 | + ret = regmap_update_bits(rv3029->regmap, RV3029_STATUS, |
|---|
| 167 | + RV3029_STATUS_VLOW1, 0); |
|---|
| 237 | 168 | if (ret < 0) |
|---|
| 238 | 169 | return ret; |
|---|
| 239 | 170 | usleep_range(1000, 10000); |
|---|
| 240 | | - ret = rv3029_get_sr(dev, &sr); |
|---|
| 171 | + ret = regmap_read(rv3029->regmap, RV3029_STATUS, &sr); |
|---|
| 241 | 172 | if (ret < 0) |
|---|
| 242 | 173 | return ret; |
|---|
| 243 | | - if (sr & (RV3029_STATUS_VLOW1 | RV3029_STATUS_VLOW2)) { |
|---|
| 244 | | - dev_err(dev, |
|---|
| 174 | + if (sr & RV3029_STATUS_VLOW1) { |
|---|
| 175 | + dev_err(rv3029->dev, |
|---|
| 245 | 176 | "Supply voltage is too low to safely access the EEPROM.\n"); |
|---|
| 246 | 177 | return -ENODEV; |
|---|
| 247 | 178 | } |
|---|
| 248 | 179 | } |
|---|
| 249 | 180 | |
|---|
| 250 | 181 | /* Disable eeprom refresh. */ |
|---|
| 251 | | - ret = rv3029_update_bits(dev, RV3029_ONOFF_CTRL, RV3029_ONOFF_CTRL_EERE, |
|---|
| 252 | | - 0); |
|---|
| 182 | + ret = regmap_update_bits(rv3029->regmap, RV3029_ONOFF_CTRL, |
|---|
| 183 | + RV3029_ONOFF_CTRL_EERE, 0); |
|---|
| 253 | 184 | if (ret < 0) |
|---|
| 254 | 185 | return ret; |
|---|
| 255 | 186 | |
|---|
| 256 | 187 | /* Wait for any previous eeprom accesses to finish. */ |
|---|
| 257 | | - ret = rv3029_eeprom_busywait(dev); |
|---|
| 188 | + ret = rv3029_eeprom_busywait(rv3029); |
|---|
| 258 | 189 | if (ret < 0) |
|---|
| 259 | | - rv3029_eeprom_exit(dev); |
|---|
| 190 | + rv3029_eeprom_exit(rv3029); |
|---|
| 260 | 191 | |
|---|
| 261 | 192 | return ret; |
|---|
| 262 | 193 | } |
|---|
| 263 | 194 | |
|---|
| 264 | | -static int rv3029_eeprom_read(struct device *dev, u8 reg, |
|---|
| 195 | +static int rv3029_eeprom_read(struct rv3029_data *rv3029, u8 reg, |
|---|
| 265 | 196 | u8 buf[], size_t len) |
|---|
| 266 | 197 | { |
|---|
| 267 | 198 | int ret, err; |
|---|
| 268 | 199 | |
|---|
| 269 | | - err = rv3029_eeprom_enter(dev); |
|---|
| 200 | + err = rv3029_eeprom_enter(rv3029); |
|---|
| 270 | 201 | if (err < 0) |
|---|
| 271 | 202 | return err; |
|---|
| 272 | 203 | |
|---|
| 273 | | - ret = rv3029_read_regs(dev, reg, buf, len); |
|---|
| 204 | + ret = regmap_bulk_read(rv3029->regmap, reg, buf, len); |
|---|
| 274 | 205 | |
|---|
| 275 | | - err = rv3029_eeprom_exit(dev); |
|---|
| 206 | + err = rv3029_eeprom_exit(rv3029); |
|---|
| 276 | 207 | if (err < 0) |
|---|
| 277 | 208 | return err; |
|---|
| 278 | 209 | |
|---|
| 279 | 210 | return ret; |
|---|
| 280 | 211 | } |
|---|
| 281 | 212 | |
|---|
| 282 | | -static int rv3029_eeprom_write(struct device *dev, u8 reg, |
|---|
| 213 | +static int rv3029_eeprom_write(struct rv3029_data *rv3029, u8 reg, |
|---|
| 283 | 214 | u8 const buf[], size_t len) |
|---|
| 284 | 215 | { |
|---|
| 216 | + unsigned int tmp; |
|---|
| 285 | 217 | int ret, err; |
|---|
| 286 | 218 | size_t i; |
|---|
| 287 | | - u8 tmp; |
|---|
| 288 | 219 | |
|---|
| 289 | | - err = rv3029_eeprom_enter(dev); |
|---|
| 220 | + err = rv3029_eeprom_enter(rv3029); |
|---|
| 290 | 221 | if (err < 0) |
|---|
| 291 | 222 | return err; |
|---|
| 292 | 223 | |
|---|
| 293 | 224 | for (i = 0; i < len; i++, reg++) { |
|---|
| 294 | | - ret = rv3029_read_regs(dev, reg, &tmp, 1); |
|---|
| 225 | + ret = regmap_read(rv3029->regmap, reg, &tmp); |
|---|
| 295 | 226 | if (ret < 0) |
|---|
| 296 | 227 | break; |
|---|
| 297 | 228 | if (tmp != buf[i]) { |
|---|
| 298 | | - ret = rv3029_write_regs(dev, reg, &buf[i], 1); |
|---|
| 229 | + tmp = buf[i]; |
|---|
| 230 | + ret = regmap_write(rv3029->regmap, reg, tmp); |
|---|
| 299 | 231 | if (ret < 0) |
|---|
| 300 | 232 | break; |
|---|
| 301 | 233 | } |
|---|
| 302 | | - ret = rv3029_eeprom_busywait(dev); |
|---|
| 234 | + ret = rv3029_eeprom_busywait(rv3029); |
|---|
| 303 | 235 | if (ret < 0) |
|---|
| 304 | 236 | break; |
|---|
| 305 | 237 | } |
|---|
| 306 | 238 | |
|---|
| 307 | | - err = rv3029_eeprom_exit(dev); |
|---|
| 239 | + err = rv3029_eeprom_exit(rv3029); |
|---|
| 308 | 240 | if (err < 0) |
|---|
| 309 | 241 | return err; |
|---|
| 310 | 242 | |
|---|
| 311 | 243 | return ret; |
|---|
| 312 | 244 | } |
|---|
| 313 | 245 | |
|---|
| 314 | | -static int rv3029_eeprom_update_bits(struct device *dev, |
|---|
| 246 | +static int rv3029_eeprom_update_bits(struct rv3029_data *rv3029, |
|---|
| 315 | 247 | u8 reg, u8 mask, u8 set) |
|---|
| 316 | 248 | { |
|---|
| 317 | 249 | u8 buf; |
|---|
| 318 | 250 | int ret; |
|---|
| 319 | 251 | |
|---|
| 320 | | - ret = rv3029_eeprom_read(dev, reg, &buf, 1); |
|---|
| 252 | + ret = rv3029_eeprom_read(rv3029, reg, &buf, 1); |
|---|
| 321 | 253 | if (ret < 0) |
|---|
| 322 | 254 | return ret; |
|---|
| 323 | 255 | buf &= ~mask; |
|---|
| 324 | 256 | buf |= set & mask; |
|---|
| 325 | | - ret = rv3029_eeprom_write(dev, reg, &buf, 1); |
|---|
| 257 | + ret = rv3029_eeprom_write(rv3029, reg, &buf, 1); |
|---|
| 326 | 258 | if (ret < 0) |
|---|
| 327 | 259 | return ret; |
|---|
| 328 | 260 | |
|---|
| .. | .. |
|---|
| 334 | 266 | struct device *dev = dev_id; |
|---|
| 335 | 267 | struct rv3029_data *rv3029 = dev_get_drvdata(dev); |
|---|
| 336 | 268 | struct mutex *lock = &rv3029->rtc->ops_lock; |
|---|
| 269 | + unsigned int flags, controls; |
|---|
| 337 | 270 | unsigned long events = 0; |
|---|
| 338 | | - u8 flags, controls; |
|---|
| 339 | 271 | int ret; |
|---|
| 340 | 272 | |
|---|
| 341 | 273 | mutex_lock(lock); |
|---|
| 342 | 274 | |
|---|
| 343 | | - ret = rv3029_read_regs(dev, RV3029_IRQ_CTRL, &controls, 1); |
|---|
| 275 | + ret = regmap_read(rv3029->regmap, RV3029_IRQ_CTRL, &controls); |
|---|
| 344 | 276 | if (ret) { |
|---|
| 345 | 277 | dev_warn(dev, "Read IRQ Control Register error %d\n", ret); |
|---|
| 346 | 278 | mutex_unlock(lock); |
|---|
| 347 | 279 | return IRQ_NONE; |
|---|
| 348 | 280 | } |
|---|
| 349 | 281 | |
|---|
| 350 | | - ret = rv3029_read_regs(dev, RV3029_IRQ_FLAGS, &flags, 1); |
|---|
| 282 | + ret = regmap_read(rv3029->regmap, RV3029_IRQ_FLAGS, &flags); |
|---|
| 351 | 283 | if (ret) { |
|---|
| 352 | 284 | dev_warn(dev, "Read IRQ Flags Register error %d\n", ret); |
|---|
| 353 | 285 | mutex_unlock(lock); |
|---|
| .. | .. |
|---|
| 362 | 294 | |
|---|
| 363 | 295 | if (events) { |
|---|
| 364 | 296 | rtc_update_irq(rv3029->rtc, 1, events); |
|---|
| 365 | | - rv3029_write_regs(dev, RV3029_IRQ_FLAGS, &flags, 1); |
|---|
| 366 | | - rv3029_write_regs(dev, RV3029_IRQ_CTRL, &controls, 1); |
|---|
| 297 | + regmap_write(rv3029->regmap, RV3029_IRQ_FLAGS, flags); |
|---|
| 298 | + regmap_write(rv3029->regmap, RV3029_IRQ_CTRL, controls); |
|---|
| 367 | 299 | } |
|---|
| 368 | 300 | mutex_unlock(lock); |
|---|
| 369 | 301 | |
|---|
| .. | .. |
|---|
| 372 | 304 | |
|---|
| 373 | 305 | static int rv3029_read_time(struct device *dev, struct rtc_time *tm) |
|---|
| 374 | 306 | { |
|---|
| 375 | | - u8 buf[1]; |
|---|
| 307 | + struct rv3029_data *rv3029 = dev_get_drvdata(dev); |
|---|
| 308 | + unsigned int sr; |
|---|
| 376 | 309 | int ret; |
|---|
| 377 | 310 | u8 regs[RV3029_WATCH_SECTION_LEN] = { 0, }; |
|---|
| 378 | 311 | |
|---|
| 379 | | - ret = rv3029_get_sr(dev, buf); |
|---|
| 380 | | - if (ret < 0) { |
|---|
| 381 | | - dev_err(dev, "%s: reading SR failed\n", __func__); |
|---|
| 382 | | - return -EIO; |
|---|
| 383 | | - } |
|---|
| 384 | | - |
|---|
| 385 | | - ret = rv3029_read_regs(dev, RV3029_W_SEC, regs, |
|---|
| 386 | | - RV3029_WATCH_SECTION_LEN); |
|---|
| 387 | | - if (ret < 0) { |
|---|
| 388 | | - dev_err(dev, "%s: reading RTC section failed\n", __func__); |
|---|
| 312 | + ret = regmap_read(rv3029->regmap, RV3029_STATUS, &sr); |
|---|
| 313 | + if (ret < 0) |
|---|
| 389 | 314 | return ret; |
|---|
| 390 | | - } |
|---|
| 315 | + |
|---|
| 316 | + if (sr & (RV3029_STATUS_VLOW2 | RV3029_STATUS_PON)) |
|---|
| 317 | + return -EINVAL; |
|---|
| 318 | + |
|---|
| 319 | + ret = regmap_bulk_read(rv3029->regmap, RV3029_W_SEC, regs, |
|---|
| 320 | + RV3029_WATCH_SECTION_LEN); |
|---|
| 321 | + if (ret < 0) |
|---|
| 322 | + return ret; |
|---|
| 391 | 323 | |
|---|
| 392 | 324 | tm->tm_sec = bcd2bin(regs[RV3029_W_SEC - RV3029_W_SEC]); |
|---|
| 393 | 325 | tm->tm_min = bcd2bin(regs[RV3029_W_MINUTES - RV3029_W_SEC]); |
|---|
| .. | .. |
|---|
| 415 | 347 | |
|---|
| 416 | 348 | static int rv3029_read_alarm(struct device *dev, struct rtc_wkalrm *alarm) |
|---|
| 417 | 349 | { |
|---|
| 350 | + struct rv3029_data *rv3029 = dev_get_drvdata(dev); |
|---|
| 418 | 351 | struct rtc_time *const tm = &alarm->time; |
|---|
| 352 | + unsigned int controls, flags; |
|---|
| 419 | 353 | int ret; |
|---|
| 420 | | - u8 regs[8], controls, flags; |
|---|
| 354 | + u8 regs[8]; |
|---|
| 421 | 355 | |
|---|
| 422 | | - ret = rv3029_get_sr(dev, regs); |
|---|
| 423 | | - if (ret < 0) { |
|---|
| 424 | | - dev_err(dev, "%s: reading SR failed\n", __func__); |
|---|
| 425 | | - return -EIO; |
|---|
| 426 | | - } |
|---|
| 427 | | - |
|---|
| 428 | | - ret = rv3029_read_regs(dev, RV3029_A_SC, regs, |
|---|
| 356 | + ret = regmap_bulk_read(rv3029->regmap, RV3029_A_SC, regs, |
|---|
| 429 | 357 | RV3029_ALARM_SECTION_LEN); |
|---|
| 358 | + if (ret < 0) |
|---|
| 359 | + return ret; |
|---|
| 430 | 360 | |
|---|
| 431 | | - if (ret < 0) { |
|---|
| 432 | | - dev_err(dev, "%s: reading alarm section failed\n", __func__); |
|---|
| 361 | + ret = regmap_read(rv3029->regmap, RV3029_IRQ_CTRL, &controls); |
|---|
| 362 | + if (ret) |
|---|
| 433 | 363 | return ret; |
|---|
| 434 | | - } |
|---|
| 435 | 364 | |
|---|
| 436 | | - ret = rv3029_read_regs(dev, RV3029_IRQ_CTRL, &controls, 1); |
|---|
| 437 | | - if (ret) { |
|---|
| 438 | | - dev_err(dev, "Read IRQ Control Register error %d\n", ret); |
|---|
| 365 | + ret = regmap_read(rv3029->regmap, RV3029_IRQ_FLAGS, &flags); |
|---|
| 366 | + if (ret < 0) |
|---|
| 439 | 367 | return ret; |
|---|
| 440 | | - } |
|---|
| 441 | | - ret = rv3029_read_regs(dev, RV3029_IRQ_FLAGS, &flags, 1); |
|---|
| 442 | | - if (ret < 0) { |
|---|
| 443 | | - dev_err(dev, "Read IRQ Flags Register error %d\n", ret); |
|---|
| 444 | | - return ret; |
|---|
| 445 | | - } |
|---|
| 446 | 368 | |
|---|
| 447 | 369 | tm->tm_sec = bcd2bin(regs[RV3029_A_SC - RV3029_A_SC] & 0x7f); |
|---|
| 448 | 370 | tm->tm_min = bcd2bin(regs[RV3029_A_MN - RV3029_A_SC] & 0x7f); |
|---|
| .. | .. |
|---|
| 460 | 382 | |
|---|
| 461 | 383 | static int rv3029_alarm_irq_enable(struct device *dev, unsigned int enable) |
|---|
| 462 | 384 | { |
|---|
| 463 | | - int ret; |
|---|
| 464 | | - u8 controls; |
|---|
| 385 | + struct rv3029_data *rv3029 = dev_get_drvdata(dev); |
|---|
| 465 | 386 | |
|---|
| 466 | | - ret = rv3029_read_regs(dev, RV3029_IRQ_CTRL, &controls, 1); |
|---|
| 467 | | - if (ret < 0) { |
|---|
| 468 | | - dev_warn(dev, "Read IRQ Control Register error %d\n", ret); |
|---|
| 469 | | - return ret; |
|---|
| 470 | | - } |
|---|
| 471 | | - |
|---|
| 472 | | - /* enable/disable AIE irq */ |
|---|
| 473 | | - if (enable) |
|---|
| 474 | | - controls |= RV3029_IRQ_CTRL_AIE; |
|---|
| 475 | | - else |
|---|
| 476 | | - controls &= ~RV3029_IRQ_CTRL_AIE; |
|---|
| 477 | | - |
|---|
| 478 | | - ret = rv3029_write_regs(dev, RV3029_IRQ_CTRL, &controls, 1); |
|---|
| 479 | | - if (ret < 0) { |
|---|
| 480 | | - dev_err(dev, "can't update INT reg\n"); |
|---|
| 481 | | - return ret; |
|---|
| 482 | | - } |
|---|
| 483 | | - |
|---|
| 484 | | - return 0; |
|---|
| 387 | + return regmap_update_bits(rv3029->regmap, RV3029_IRQ_CTRL, |
|---|
| 388 | + RV3029_IRQ_CTRL_AIE, |
|---|
| 389 | + enable ? RV3029_IRQ_CTRL_AIE : 0); |
|---|
| 485 | 390 | } |
|---|
| 486 | 391 | |
|---|
| 487 | 392 | static int rv3029_set_alarm(struct device *dev, struct rtc_wkalrm *alarm) |
|---|
| 488 | 393 | { |
|---|
| 394 | + struct rv3029_data *rv3029 = dev_get_drvdata(dev); |
|---|
| 489 | 395 | struct rtc_time *const tm = &alarm->time; |
|---|
| 490 | 396 | int ret; |
|---|
| 491 | 397 | u8 regs[8]; |
|---|
| 492 | | - |
|---|
| 493 | | - /* |
|---|
| 494 | | - * The clock has an 8 bit wide bcd-coded register (they never learn) |
|---|
| 495 | | - * for the year. tm_year is an offset from 1900 and we are interested |
|---|
| 496 | | - * in the 2000-2099 range, so any value less than 100 is invalid. |
|---|
| 497 | | - */ |
|---|
| 498 | | - if (tm->tm_year < 100) |
|---|
| 499 | | - return -EINVAL; |
|---|
| 500 | | - |
|---|
| 501 | | - ret = rv3029_get_sr(dev, regs); |
|---|
| 502 | | - if (ret < 0) { |
|---|
| 503 | | - dev_err(dev, "%s: reading SR failed\n", __func__); |
|---|
| 504 | | - return -EIO; |
|---|
| 505 | | - } |
|---|
| 506 | 398 | |
|---|
| 507 | 399 | /* Activate all the alarms with AE_x bit */ |
|---|
| 508 | 400 | regs[RV3029_A_SC - RV3029_A_SC] = bin2bcd(tm->tm_sec) | RV3029_A_AE_X; |
|---|
| .. | .. |
|---|
| 519 | 411 | | RV3029_A_AE_X; |
|---|
| 520 | 412 | |
|---|
| 521 | 413 | /* Write the alarm */ |
|---|
| 522 | | - ret = rv3029_write_regs(dev, RV3029_A_SC, regs, |
|---|
| 414 | + ret = regmap_bulk_write(rv3029->regmap, RV3029_A_SC, regs, |
|---|
| 523 | 415 | RV3029_ALARM_SECTION_LEN); |
|---|
| 524 | 416 | if (ret < 0) |
|---|
| 525 | 417 | return ret; |
|---|
| 526 | 418 | |
|---|
| 527 | | - if (alarm->enabled) { |
|---|
| 528 | | - /* enable AIE irq */ |
|---|
| 529 | | - ret = rv3029_alarm_irq_enable(dev, 1); |
|---|
| 530 | | - if (ret) |
|---|
| 531 | | - return ret; |
|---|
| 532 | | - } else { |
|---|
| 533 | | - /* disable AIE irq */ |
|---|
| 534 | | - ret = rv3029_alarm_irq_enable(dev, 0); |
|---|
| 535 | | - if (ret) |
|---|
| 536 | | - return ret; |
|---|
| 537 | | - } |
|---|
| 538 | | - |
|---|
| 539 | | - return 0; |
|---|
| 419 | + return rv3029_alarm_irq_enable(dev, alarm->enabled); |
|---|
| 540 | 420 | } |
|---|
| 541 | 421 | |
|---|
| 542 | 422 | static int rv3029_set_time(struct device *dev, struct rtc_time *tm) |
|---|
| 543 | 423 | { |
|---|
| 424 | + struct rv3029_data *rv3029 = dev_get_drvdata(dev); |
|---|
| 544 | 425 | u8 regs[8]; |
|---|
| 545 | 426 | int ret; |
|---|
| 546 | | - |
|---|
| 547 | | - /* |
|---|
| 548 | | - * The clock has an 8 bit wide bcd-coded register (they never learn) |
|---|
| 549 | | - * for the year. tm_year is an offset from 1900 and we are interested |
|---|
| 550 | | - * in the 2000-2099 range, so any value less than 100 is invalid. |
|---|
| 551 | | - */ |
|---|
| 552 | | - if (tm->tm_year < 100) |
|---|
| 553 | | - return -EINVAL; |
|---|
| 554 | 427 | |
|---|
| 555 | 428 | regs[RV3029_W_SEC - RV3029_W_SEC] = bin2bcd(tm->tm_sec); |
|---|
| 556 | 429 | regs[RV3029_W_MINUTES - RV3029_W_SEC] = bin2bcd(tm->tm_min); |
|---|
| .. | .. |
|---|
| 560 | 433 | regs[RV3029_W_DAYS - RV3029_W_SEC] = bin2bcd(tm->tm_wday + 1) & 0x7; |
|---|
| 561 | 434 | regs[RV3029_W_YEARS - RV3029_W_SEC] = bin2bcd(tm->tm_year - 100); |
|---|
| 562 | 435 | |
|---|
| 563 | | - ret = rv3029_write_regs(dev, RV3029_W_SEC, regs, |
|---|
| 436 | + ret = regmap_bulk_write(rv3029->regmap, RV3029_W_SEC, regs, |
|---|
| 564 | 437 | RV3029_WATCH_SECTION_LEN); |
|---|
| 565 | 438 | if (ret < 0) |
|---|
| 566 | 439 | return ret; |
|---|
| 567 | 440 | |
|---|
| 568 | | - ret = rv3029_get_sr(dev, regs); |
|---|
| 569 | | - if (ret < 0) { |
|---|
| 570 | | - dev_err(dev, "%s: reading SR failed\n", __func__); |
|---|
| 571 | | - return ret; |
|---|
| 572 | | - } |
|---|
| 573 | | - /* clear PON bit */ |
|---|
| 574 | | - ret = rv3029_set_sr(dev, (regs[0] & ~RV3029_STATUS_PON)); |
|---|
| 575 | | - if (ret < 0) { |
|---|
| 576 | | - dev_err(dev, "%s: reading SR failed\n", __func__); |
|---|
| 577 | | - return ret; |
|---|
| 578 | | - } |
|---|
| 441 | + /* clear PON and VLOW2 bits */ |
|---|
| 442 | + return regmap_update_bits(rv3029->regmap, RV3029_STATUS, |
|---|
| 443 | + RV3029_STATUS_PON | RV3029_STATUS_VLOW2, 0); |
|---|
| 444 | +} |
|---|
| 579 | 445 | |
|---|
| 580 | | - return 0; |
|---|
| 446 | +static int rv3029_ioctl(struct device *dev, unsigned int cmd, unsigned long arg) |
|---|
| 447 | +{ |
|---|
| 448 | + struct rv3029_data *rv3029 = dev_get_drvdata(dev); |
|---|
| 449 | + unsigned long vl = 0; |
|---|
| 450 | + int sr, ret = 0; |
|---|
| 451 | + |
|---|
| 452 | + switch (cmd) { |
|---|
| 453 | + case RTC_VL_READ: |
|---|
| 454 | + ret = regmap_read(rv3029->regmap, RV3029_STATUS, &sr); |
|---|
| 455 | + if (ret < 0) |
|---|
| 456 | + return ret; |
|---|
| 457 | + |
|---|
| 458 | + if (sr & RV3029_STATUS_VLOW1) |
|---|
| 459 | + vl = RTC_VL_ACCURACY_LOW; |
|---|
| 460 | + |
|---|
| 461 | + if (sr & (RV3029_STATUS_VLOW2 | RV3029_STATUS_PON)) |
|---|
| 462 | + vl |= RTC_VL_DATA_INVALID; |
|---|
| 463 | + |
|---|
| 464 | + return put_user(vl, (unsigned int __user *)arg); |
|---|
| 465 | + |
|---|
| 466 | + case RTC_VL_CLR: |
|---|
| 467 | + return regmap_update_bits(rv3029->regmap, RV3029_STATUS, |
|---|
| 468 | + RV3029_STATUS_VLOW1, 0); |
|---|
| 469 | + |
|---|
| 470 | + default: |
|---|
| 471 | + return -ENOIOCTLCMD; |
|---|
| 472 | + } |
|---|
| 473 | +} |
|---|
| 474 | + |
|---|
| 475 | +static int rv3029_nvram_write(void *priv, unsigned int offset, void *val, |
|---|
| 476 | + size_t bytes) |
|---|
| 477 | +{ |
|---|
| 478 | + return regmap_bulk_write(priv, RV3029_RAM_PAGE + offset, val, bytes); |
|---|
| 479 | +} |
|---|
| 480 | + |
|---|
| 481 | +static int rv3029_nvram_read(void *priv, unsigned int offset, void *val, |
|---|
| 482 | + size_t bytes) |
|---|
| 483 | +{ |
|---|
| 484 | + return regmap_bulk_read(priv, RV3029_RAM_PAGE + offset, val, bytes); |
|---|
| 581 | 485 | } |
|---|
| 582 | 486 | |
|---|
| 583 | 487 | static const struct rv3029_trickle_tab_elem { |
|---|
| .. | .. |
|---|
| 639 | 543 | |
|---|
| 640 | 544 | static void rv3029_trickle_config(struct device *dev) |
|---|
| 641 | 545 | { |
|---|
| 546 | + struct rv3029_data *rv3029 = dev_get_drvdata(dev); |
|---|
| 642 | 547 | struct device_node *of_node = dev->of_node; |
|---|
| 643 | 548 | const struct rv3029_trickle_tab_elem *elem; |
|---|
| 644 | 549 | int i, err; |
|---|
| .. | .. |
|---|
| 665 | 570 | "Trickle charger enabled at %d ohms resistance.\n", |
|---|
| 666 | 571 | elem->r); |
|---|
| 667 | 572 | } |
|---|
| 668 | | - err = rv3029_eeprom_update_bits(dev, RV3029_CONTROL_E2P_EECTRL, |
|---|
| 573 | + err = rv3029_eeprom_update_bits(rv3029, RV3029_CONTROL_E2P_EECTRL, |
|---|
| 669 | 574 | RV3029_TRICKLE_MASK, |
|---|
| 670 | 575 | trickle_set_bits); |
|---|
| 671 | 576 | if (err < 0) |
|---|
| .. | .. |
|---|
| 674 | 579 | |
|---|
| 675 | 580 | #ifdef CONFIG_RTC_DRV_RV3029_HWMON |
|---|
| 676 | 581 | |
|---|
| 677 | | -static int rv3029_read_temp(struct device *dev, int *temp_mC) |
|---|
| 582 | +static int rv3029_read_temp(struct rv3029_data *rv3029, int *temp_mC) |
|---|
| 678 | 583 | { |
|---|
| 584 | + unsigned int temp; |
|---|
| 679 | 585 | int ret; |
|---|
| 680 | | - u8 temp; |
|---|
| 681 | 586 | |
|---|
| 682 | | - ret = rv3029_read_regs(dev, RV3029_TEMP_PAGE, &temp, 1); |
|---|
| 587 | + ret = regmap_read(rv3029->regmap, RV3029_TEMP_PAGE, &temp); |
|---|
| 683 | 588 | if (ret < 0) |
|---|
| 684 | 589 | return ret; |
|---|
| 685 | 590 | |
|---|
| .. | .. |
|---|
| 692 | 597 | struct device_attribute *attr, |
|---|
| 693 | 598 | char *buf) |
|---|
| 694 | 599 | { |
|---|
| 600 | + struct rv3029_data *rv3029 = dev_get_drvdata(dev); |
|---|
| 695 | 601 | int ret, temp_mC; |
|---|
| 696 | 602 | |
|---|
| 697 | | - ret = rv3029_read_temp(dev, &temp_mC); |
|---|
| 603 | + ret = rv3029_read_temp(rv3029, &temp_mC); |
|---|
| 698 | 604 | if (ret < 0) |
|---|
| 699 | 605 | return ret; |
|---|
| 700 | 606 | |
|---|
| .. | .. |
|---|
| 706 | 612 | const char *buf, |
|---|
| 707 | 613 | size_t count) |
|---|
| 708 | 614 | { |
|---|
| 615 | + struct rv3029_data *rv3029 = dev_get_drvdata(dev); |
|---|
| 616 | + unsigned int th_set_bits = 0; |
|---|
| 709 | 617 | unsigned long interval_ms; |
|---|
| 710 | 618 | int ret; |
|---|
| 711 | | - u8 th_set_bits = 0; |
|---|
| 712 | 619 | |
|---|
| 713 | 620 | ret = kstrtoul(buf, 10, &interval_ms); |
|---|
| 714 | 621 | if (ret < 0) |
|---|
| .. | .. |
|---|
| 719 | 626 | if (interval_ms >= 16000) |
|---|
| 720 | 627 | th_set_bits |= RV3029_EECTRL_THP; |
|---|
| 721 | 628 | } |
|---|
| 722 | | - ret = rv3029_eeprom_update_bits(dev, RV3029_CONTROL_E2P_EECTRL, |
|---|
| 629 | + ret = rv3029_eeprom_update_bits(rv3029, RV3029_CONTROL_E2P_EECTRL, |
|---|
| 723 | 630 | RV3029_EECTRL_THE | RV3029_EECTRL_THP, |
|---|
| 724 | 631 | th_set_bits); |
|---|
| 725 | 632 | if (ret < 0) |
|---|
| .. | .. |
|---|
| 732 | 639 | struct device_attribute *attr, |
|---|
| 733 | 640 | char *buf) |
|---|
| 734 | 641 | { |
|---|
| 642 | + struct rv3029_data *rv3029 = dev_get_drvdata(dev); |
|---|
| 735 | 643 | int ret, interval_ms; |
|---|
| 736 | 644 | u8 eectrl; |
|---|
| 737 | 645 | |
|---|
| 738 | | - ret = rv3029_eeprom_read(dev, RV3029_CONTROL_E2P_EECTRL, |
|---|
| 646 | + ret = rv3029_eeprom_read(rv3029, RV3029_CONTROL_E2P_EECTRL, |
|---|
| 739 | 647 | &eectrl, 1); |
|---|
| 740 | 648 | if (ret < 0) |
|---|
| 741 | 649 | return ret; |
|---|
| .. | .. |
|---|
| 789 | 697 | static struct rtc_class_ops rv3029_rtc_ops = { |
|---|
| 790 | 698 | .read_time = rv3029_read_time, |
|---|
| 791 | 699 | .set_time = rv3029_set_time, |
|---|
| 700 | + .ioctl = rv3029_ioctl, |
|---|
| 792 | 701 | }; |
|---|
| 793 | 702 | |
|---|
| 794 | 703 | static int rv3029_probe(struct device *dev, struct regmap *regmap, int irq, |
|---|
| 795 | 704 | const char *name) |
|---|
| 796 | 705 | { |
|---|
| 797 | 706 | struct rv3029_data *rv3029; |
|---|
| 707 | + struct nvmem_config nvmem_cfg = { |
|---|
| 708 | + .name = "rv3029_nvram", |
|---|
| 709 | + .word_size = 1, |
|---|
| 710 | + .stride = 1, |
|---|
| 711 | + .size = RV3029_RAM_SECTION_LEN, |
|---|
| 712 | + .type = NVMEM_TYPE_BATTERY_BACKED, |
|---|
| 713 | + .reg_read = rv3029_nvram_read, |
|---|
| 714 | + .reg_write = rv3029_nvram_write, |
|---|
| 715 | + }; |
|---|
| 798 | 716 | int rc = 0; |
|---|
| 799 | | - u8 buf[1]; |
|---|
| 800 | 717 | |
|---|
| 801 | 718 | rv3029 = devm_kzalloc(dev, sizeof(*rv3029), GFP_KERNEL); |
|---|
| 802 | 719 | if (!rv3029) |
|---|
| .. | .. |
|---|
| 807 | 724 | rv3029->dev = dev; |
|---|
| 808 | 725 | dev_set_drvdata(dev, rv3029); |
|---|
| 809 | 726 | |
|---|
| 810 | | - rc = rv3029_get_sr(dev, buf); |
|---|
| 811 | | - if (rc < 0) { |
|---|
| 812 | | - dev_err(dev, "reading status failed\n"); |
|---|
| 813 | | - return rc; |
|---|
| 814 | | - } |
|---|
| 815 | | - |
|---|
| 816 | 727 | rv3029_trickle_config(dev); |
|---|
| 817 | 728 | rv3029_hwmon_register(dev, name); |
|---|
| 818 | 729 | |
|---|
| 819 | | - rv3029->rtc = devm_rtc_device_register(dev, name, &rv3029_rtc_ops, |
|---|
| 820 | | - THIS_MODULE); |
|---|
| 821 | | - if (IS_ERR(rv3029->rtc)) { |
|---|
| 822 | | - dev_err(dev, "unable to register the class device\n"); |
|---|
| 730 | + rv3029->rtc = devm_rtc_allocate_device(dev); |
|---|
| 731 | + if (IS_ERR(rv3029->rtc)) |
|---|
| 823 | 732 | return PTR_ERR(rv3029->rtc); |
|---|
| 824 | | - } |
|---|
| 825 | 733 | |
|---|
| 826 | 734 | if (rv3029->irq > 0) { |
|---|
| 827 | 735 | rc = devm_request_threaded_irq(dev, rv3029->irq, |
|---|
| .. | .. |
|---|
| 838 | 746 | } |
|---|
| 839 | 747 | } |
|---|
| 840 | 748 | |
|---|
| 749 | + rv3029->rtc->ops = &rv3029_rtc_ops; |
|---|
| 750 | + rv3029->rtc->range_min = RTC_TIMESTAMP_BEGIN_2000; |
|---|
| 751 | + rv3029->rtc->range_max = RTC_TIMESTAMP_END_2079; |
|---|
| 752 | + |
|---|
| 753 | + rc = rtc_register_device(rv3029->rtc); |
|---|
| 754 | + if (rc) |
|---|
| 755 | + return rc; |
|---|
| 756 | + |
|---|
| 757 | + nvmem_cfg.priv = rv3029->regmap; |
|---|
| 758 | + rtc_nvmem_register(rv3029->rtc, &nvmem_cfg); |
|---|
| 759 | + |
|---|
| 841 | 760 | return 0; |
|---|
| 842 | 761 | } |
|---|
| 762 | + |
|---|
| 763 | +static const struct regmap_range rv3029_holes_range[] = { |
|---|
| 764 | + regmap_reg_range(0x05, 0x07), |
|---|
| 765 | + regmap_reg_range(0x0f, 0x0f), |
|---|
| 766 | + regmap_reg_range(0x17, 0x17), |
|---|
| 767 | + regmap_reg_range(0x1a, 0x1f), |
|---|
| 768 | + regmap_reg_range(0x21, 0x27), |
|---|
| 769 | + regmap_reg_range(0x34, 0x37), |
|---|
| 770 | +}; |
|---|
| 771 | + |
|---|
| 772 | +static const struct regmap_access_table rv3029_regs = { |
|---|
| 773 | + .no_ranges = rv3029_holes_range, |
|---|
| 774 | + .n_no_ranges = ARRAY_SIZE(rv3029_holes_range), |
|---|
| 775 | +}; |
|---|
| 776 | + |
|---|
| 777 | +static const struct regmap_config config = { |
|---|
| 778 | + .reg_bits = 8, |
|---|
| 779 | + .val_bits = 8, |
|---|
| 780 | + .rd_table = &rv3029_regs, |
|---|
| 781 | + .wr_table = &rv3029_regs, |
|---|
| 782 | + .max_register = 0x3f, |
|---|
| 783 | +}; |
|---|
| 843 | 784 | |
|---|
| 844 | 785 | #if IS_ENABLED(CONFIG_I2C) |
|---|
| 845 | 786 | |
|---|
| .. | .. |
|---|
| 847 | 788 | const struct i2c_device_id *id) |
|---|
| 848 | 789 | { |
|---|
| 849 | 790 | struct regmap *regmap; |
|---|
| 850 | | - static const struct regmap_config config = { |
|---|
| 851 | | - .reg_bits = 8, |
|---|
| 852 | | - .val_bits = 8, |
|---|
| 853 | | - }; |
|---|
| 854 | | - |
|---|
| 855 | 791 | if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_I2C_BLOCK | |
|---|
| 856 | 792 | I2C_FUNC_SMBUS_BYTE)) { |
|---|
| 857 | 793 | dev_err(&client->dev, "Adapter does not support SMBUS_I2C_BLOCK or SMBUS_I2C_BYTE\n"); |
|---|
| .. | .. |
|---|
| 859 | 795 | } |
|---|
| 860 | 796 | |
|---|
| 861 | 797 | regmap = devm_regmap_init_i2c(client, &config); |
|---|
| 862 | | - if (IS_ERR(regmap)) { |
|---|
| 863 | | - dev_err(&client->dev, "%s: regmap allocation failed: %ld\n", |
|---|
| 864 | | - __func__, PTR_ERR(regmap)); |
|---|
| 798 | + if (IS_ERR(regmap)) |
|---|
| 865 | 799 | return PTR_ERR(regmap); |
|---|
| 866 | | - } |
|---|
| 867 | 800 | |
|---|
| 868 | 801 | return rv3029_probe(&client->dev, regmap, client->irq, client->name); |
|---|
| 869 | 802 | } |
|---|
| .. | .. |
|---|
| 877 | 810 | |
|---|
| 878 | 811 | static const struct of_device_id rv3029_of_match[] = { |
|---|
| 879 | 812 | { .compatible = "microcrystal,rv3029" }, |
|---|
| 880 | | - /* Backward compatibility only, do not use compatibles below: */ |
|---|
| 881 | | - { .compatible = "rv3029" }, |
|---|
| 882 | | - { .compatible = "rv3029c2" }, |
|---|
| 883 | | - { .compatible = "mc,rv3029c2" }, |
|---|
| 884 | 813 | { } |
|---|
| 885 | 814 | }; |
|---|
| 886 | 815 | MODULE_DEVICE_TABLE(of, rv3029_of_match); |
|---|
| 887 | 816 | |
|---|
| 888 | 817 | static struct i2c_driver rv3029_driver = { |
|---|
| 889 | 818 | .driver = { |
|---|
| 890 | | - .name = "rtc-rv3029c2", |
|---|
| 819 | + .name = "rv3029", |
|---|
| 891 | 820 | .of_match_table = of_match_ptr(rv3029_of_match), |
|---|
| 892 | 821 | }, |
|---|
| 893 | 822 | .probe = rv3029_i2c_probe, |
|---|
| 894 | 823 | .id_table = rv3029_id, |
|---|
| 895 | 824 | }; |
|---|
| 896 | 825 | |
|---|
| 897 | | -static int rv3029_register_driver(void) |
|---|
| 826 | +static int __init rv3029_register_driver(void) |
|---|
| 898 | 827 | { |
|---|
| 899 | 828 | return i2c_add_driver(&rv3029_driver); |
|---|
| 900 | 829 | } |
|---|
| .. | .. |
|---|
| 906 | 835 | |
|---|
| 907 | 836 | #else |
|---|
| 908 | 837 | |
|---|
| 909 | | -static int rv3029_register_driver(void) |
|---|
| 838 | +static int __init rv3029_register_driver(void) |
|---|
| 910 | 839 | { |
|---|
| 911 | 840 | return 0; |
|---|
| 912 | 841 | } |
|---|
| .. | .. |
|---|
| 921 | 850 | |
|---|
| 922 | 851 | static int rv3049_probe(struct spi_device *spi) |
|---|
| 923 | 852 | { |
|---|
| 924 | | - static const struct regmap_config config = { |
|---|
| 925 | | - .reg_bits = 8, |
|---|
| 926 | | - .val_bits = 8, |
|---|
| 927 | | - }; |
|---|
| 928 | 853 | struct regmap *regmap; |
|---|
| 929 | 854 | |
|---|
| 930 | 855 | regmap = devm_regmap_init_spi(spi, &config); |
|---|
| 931 | | - if (IS_ERR(regmap)) { |
|---|
| 932 | | - dev_err(&spi->dev, "%s: regmap allocation failed: %ld\n", |
|---|
| 933 | | - __func__, PTR_ERR(regmap)); |
|---|
| 856 | + if (IS_ERR(regmap)) |
|---|
| 934 | 857 | return PTR_ERR(regmap); |
|---|
| 935 | | - } |
|---|
| 936 | 858 | |
|---|
| 937 | 859 | return rv3029_probe(&spi->dev, regmap, spi->irq, "rv3049"); |
|---|
| 938 | 860 | } |
|---|
| .. | .. |
|---|
| 944 | 866 | .probe = rv3049_probe, |
|---|
| 945 | 867 | }; |
|---|
| 946 | 868 | |
|---|
| 947 | | -static int rv3049_register_driver(void) |
|---|
| 869 | +static int __init rv3049_register_driver(void) |
|---|
| 948 | 870 | { |
|---|
| 949 | 871 | return spi_register_driver(&rv3049_driver); |
|---|
| 950 | 872 | } |
|---|
| 951 | 873 | |
|---|
| 952 | | -static void rv3049_unregister_driver(void) |
|---|
| 874 | +static void __exit rv3049_unregister_driver(void) |
|---|
| 953 | 875 | { |
|---|
| 954 | 876 | spi_unregister_driver(&rv3049_driver); |
|---|
| 955 | 877 | } |
|---|
| 956 | 878 | |
|---|
| 957 | 879 | #else |
|---|
| 958 | 880 | |
|---|
| 959 | | -static int rv3049_register_driver(void) |
|---|
| 881 | +static int __init rv3049_register_driver(void) |
|---|
| 960 | 882 | { |
|---|
| 961 | 883 | return 0; |
|---|
| 962 | 884 | } |
|---|
| 963 | 885 | |
|---|
| 964 | | -static void rv3049_unregister_driver(void) |
|---|
| 886 | +static void __exit rv3049_unregister_driver(void) |
|---|
| 965 | 887 | { |
|---|
| 966 | 888 | } |
|---|
| 967 | 889 | |
|---|
| .. | .. |
|---|
| 972 | 894 | int ret; |
|---|
| 973 | 895 | |
|---|
| 974 | 896 | ret = rv3029_register_driver(); |
|---|
| 975 | | - if (ret) { |
|---|
| 976 | | - pr_err("Failed to register rv3029 driver: %d\n", ret); |
|---|
| 897 | + if (ret) |
|---|
| 977 | 898 | return ret; |
|---|
| 978 | | - } |
|---|
| 979 | 899 | |
|---|
| 980 | 900 | ret = rv3049_register_driver(); |
|---|
| 981 | | - if (ret) { |
|---|
| 982 | | - pr_err("Failed to register rv3049 driver: %d\n", ret); |
|---|
| 901 | + if (ret) |
|---|
| 983 | 902 | rv3029_unregister_driver(); |
|---|
| 984 | | - } |
|---|
| 985 | 903 | |
|---|
| 986 | 904 | return ret; |
|---|
| 987 | 905 | } |
|---|