| @@ -12,13 +12,7 @@ · 11 unmodified lines |
| 12 | 12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 13 | 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 14 | 14 | * GNU General Public License for more details. |
| 15 | | − * |
| 16 | | − * You should have received a copy of the GNU General Public License |
| 17 | | − * along with this program; if not, write to the Free Software |
| 18 | | − * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| 19 | | − * |
| 20 | 15 | */ |
| 21 | | − |
| 22 | 16 | #include <linux/clk.h> |
| 23 | 17 | #include <linux/module.h> |
| 24 | 18 | #include <linux/interrupt.h> |
| @@ -26,6 +20,7 @@ · 1 unmodified line |
| 26 | 20 | #include <linux/platform_device.h> |
| 27 | 21 | #include <linux/sched.h> |
| 28 | 22 | #include <linux/wait.h> |
| 23 | +#include <linux/pwm.h> |
| 29 | 24 | |
| 30 | 25 | #include <media/lirc.h> |
| 31 | 26 | #include <media/lirc_dev.h> |
| @@ -43,7 +38,7 @@ · 11 unmodified lines |
| 43 | 38 | #define TIMER_MAX_VALUE 0xffffffff |
| 44 | 39 | |
| 45 | 40 | struct lirc_rx51 { |
| 46 | | − pwm_omap_dmtimer *pwm_timer; |
| 41 | + struct pwm_device *pwm; |
| 47 | 42 | pwm_omap_dmtimer *pulse_timer; |
| 48 | 43 | struct pwm_omap_dmtimer_pdata *dmtimer; |
| 49 | 44 | struct device *dev; |
| @@ -58,32 +53,28 @@ struct lirc_rx51 { · 8 unmodified lines |
| 58 | 53 | int wbuf[WBUF_LEN]; |
| 59 | 54 | int wbuf_index; |
| 60 | 55 | unsigned long device_is_open; |
| 61 | | − int pwm_timer_num; |
| 62 | 56 | }; |
| 63 | 57 | |
| 64 | 58 | static void lirc_rx51_on(struct lirc_rx51 *lirc_rx51) |
| 65 | 59 | { |
| 66 | | − lirc_rx51->dmtimer->set_pwm(lirc_rx51->pwm_timer, 0, 1, |
| 67 | | − PWM_OMAP_DMTIMER_TRIGGER_OVERFLOW_AND_COMPARE); |
| 60 | + pwm_enable(lirc_rx51->pwm); |
| 68 | 61 | } |
| 69 | 62 | |
| 70 | 63 | static void lirc_rx51_off(struct lirc_rx51 *lirc_rx51) |
| 71 | 64 | { |
| 72 | | − lirc_rx51->dmtimer->set_pwm(lirc_rx51->pwm_timer, 0, 1, |
| 73 | | − PWM_OMAP_DMTIMER_TRIGGER_NONE); |
| 65 | + pwm_disable(lirc_rx51->pwm); |
| 74 | 66 | } |
| 75 | 67 | |
| 76 | 68 | static int init_timing_params(struct lirc_rx51 *lirc_rx51) |
| 77 | 69 | { |
| 78 | | − u32 load, match; |
| 79 | | − |
| 80 | | − load = -(lirc_rx51->fclk_khz * 1000 / lirc_rx51->freq); |
| 81 | | − match = -(lirc_rx51->duty_cycle * -load / 100); |
| 82 | | − lirc_rx51->dmtimer->set_load(lirc_rx51->pwm_timer, 1, load); |
| 83 | | − lirc_rx51->dmtimer->set_match(lirc_rx51->pwm_timer, 1, match); |
| 84 | | − lirc_rx51->dmtimer->write_counter(lirc_rx51->pwm_timer, TIMER_MAX_VALUE - 2); |
| 85 | | − lirc_rx51->dmtimer->start(lirc_rx51->pwm_timer); |
| 70 | + struct pwm_device *pwm = lirc_rx51->pwm; |
| 71 | + int duty, period = DIV_ROUND_CLOSEST(NSEC_PER_SEC, lirc_rx51->freq); |
| 72 | + |
| 73 | + duty = DIV_ROUND_CLOSEST(lirc_rx51->duty_cycle * period, 100); |
| 86 | 74 | lirc_rx51->dmtimer->set_int_enable(lirc_rx51->pulse_timer, 0); |
| 75 | + |
| 76 | + pwm_config(pwm, duty, period); |
| 77 | + |
| 87 | 78 | lirc_rx51->dmtimer->start(lirc_rx51->pulse_timer); |
| 88 | 79 | |
| 89 | 80 | lirc_rx51->match = 0; |
| @@ -165,7 +156,7 @@ end: · 75 unmodified lines |
| 165 | 156 | /* Stop TX here */ |
| 166 | 157 | lirc_rx51_off(lirc_rx51); |
| 167 | 158 | lirc_rx51->wbuf_index = -1; |
| 168 | | − lirc_rx51->dmtimer->stop(lirc_rx51->pwm_timer); |
| 159 | + |
| 169 | 160 | lirc_rx51->dmtimer->stop(lirc_rx51->pulse_timer); |
| 170 | 161 | lirc_rx51->dmtimer->set_int_enable(lirc_rx51->pulse_timer, 0); |
| 171 | 162 | wake_up_interruptible(&lirc_rx51->wqueue); |
| @@ -176,13 +167,13 @@ end: · 4 unmodified lines |
| 176 | 167 | static int lirc_rx51_init_port(struct lirc_rx51 *lirc_rx51) |
| 177 | 168 | { |
| 178 | 169 | struct clk *clk_fclk; |
| 179 | | − int retval, pwm_timer = lirc_rx51->pwm_timer_num; |
| 170 | + int retval; |
| 180 | 171 | |
| 181 | | − lirc_rx51->pwm_timer = lirc_rx51->dmtimer->request_specific(pwm_timer); |
| 182 | | − if (lirc_rx51->pwm_timer == NULL) { |
| 183 | | − dev_err(lirc_rx51->dev, ": Error requesting GPT%d timer\n", |
| 184 | | − pwm_timer); |
| 185 | | − return -EBUSY; |
| 172 | + lirc_rx51->pwm = pwm_get(lirc_rx51->dev, NULL); |
| 173 | + if (IS_ERR(lirc_rx51->pwm)) { |
| 174 | + retval = PTR_ERR(lirc_rx51->pwm); |
| 175 | + dev_err(lirc_rx51->dev, ": pwm_get failed: %d\n", retval); |
| 176 | + return retval; |
| 186 | 177 | } |
| 187 | 178 | |
| 188 | 179 | lirc_rx51->pulse_timer = lirc_rx51->dmtimer->request(); |
| @@ -192,15 +183,11 @@ static int lirc_rx51_init_port(struct lirc_rx51 *lirc_rx51) · 3 unmodified lines |
| 192 | 183 | goto err1; |
| 193 | 184 | } |
| 194 | 185 | |
| 195 | | − lirc_rx51->dmtimer->set_source(lirc_rx51->pwm_timer, |
| 196 | | − PWM_OMAP_DMTIMER_SRC_SYS_CLK); |
| 197 | 186 | lirc_rx51->dmtimer->set_source(lirc_rx51->pulse_timer, |
| 198 | 187 | PWM_OMAP_DMTIMER_SRC_SYS_CLK); |
| 199 | | − |
| 200 | | − lirc_rx51->dmtimer->enable(lirc_rx51->pwm_timer); |
| 201 | 188 | lirc_rx51->dmtimer->enable(lirc_rx51->pulse_timer); |
| 202 | | − |
| 203 | | − lirc_rx51->irq_num = lirc_rx51->dmtimer->get_irq(lirc_rx51->pulse_timer); |
| 189 | + lirc_rx51->irq_num = |
| 190 | + lirc_rx51->dmtimer->get_irq(lirc_rx51->pulse_timer); |
| 204 | 191 | retval = request_irq(lirc_rx51->irq_num, lirc_rx51_interrupt_handler, |
| 205 | 192 | IRQF_SHARED, "lirc_pulse_timer", lirc_rx51); |
| 206 | 193 | if (retval) { |
| @@ -208,7 +195,7 @@ static int lirc_rx51_init_port(struct lirc_rx51 *lirc_rx51) · 1 unmodified line |
| 208 | 195 | goto err2; |
| 209 | 196 | } |
| 210 | 197 | |
| 211 | | − clk_fclk = lirc_rx51->dmtimer->get_fclk(lirc_rx51->pwm_timer); |
| 198 | + clk_fclk = lirc_rx51->dmtimer->get_fclk(lirc_rx51->pulse_timer); |
| 212 | 199 | lirc_rx51->fclk_khz = clk_get_rate(clk_fclk) / 1000; |
| 213 | 200 | |
| 214 | 201 | return 0; |
| @@ -216,7 +203,7 @@ static int lirc_rx51_init_port(struct lirc_rx51 *lirc_rx51) · 1 unmodified line |
| 216 | 203 | err2: |
| 217 | 204 | lirc_rx51->dmtimer->free(lirc_rx51->pulse_timer); |
| 218 | 205 | err1: |
| 219 | | − lirc_rx51->dmtimer->free(lirc_rx51->pwm_timer); |
| 206 | + pwm_put(lirc_rx51->pwm); |
| 220 | 207 | |
| 221 | 208 | return retval; |
| 222 | 209 | } |
| @@ -226,11 +213,10 @@ static int lirc_rx51_free_port(struct lirc_rx51 *lirc_rx51) · 3 unmodified lines |
| 226 | 213 | lirc_rx51->dmtimer->set_int_enable(lirc_rx51->pulse_timer, 0); |
| 227 | 214 | free_irq(lirc_rx51->irq_num, lirc_rx51); |
| 228 | 215 | lirc_rx51_off(lirc_rx51); |
| 229 | | − lirc_rx51->dmtimer->disable(lirc_rx51->pwm_timer); |
| 230 | 216 | lirc_rx51->dmtimer->disable(lirc_rx51->pulse_timer); |
| 231 | | − lirc_rx51->dmtimer->free(lirc_rx51->pwm_timer); |
| 232 | 217 | lirc_rx51->dmtimer->free(lirc_rx51->pulse_timer); |
| 233 | 218 | lirc_rx51->wbuf_index = -1; |
| 219 | + pwm_put(lirc_rx51->pwm); |
| 234 | 220 | |
| 235 | 221 | return 0; |
| 236 | 222 | } |
| @@ -387,7 +373,6 @@ static int lirc_rx51_release(struct inode *inode, struct file *file) · 150 unmodified lines |
| 387 | 373 | } |
| 388 | 374 | |
| 389 | 375 | static struct lirc_rx51 lirc_rx51 = { |
| 390 | | − .freq = 38000, |
| 391 | 376 | .duty_cycle = 50, |
| 392 | 377 | .wbuf_index = -1, |
| 393 | 378 | }; |
| @@ -445,14 +430,34 @@ static int lirc_rx51_resume(struct platform_device *dev) · 51 unmodified lines |
| 445 | 430 | |
| 446 | 431 | static int lirc_rx51_probe(struct platform_device *dev) |
| 447 | 432 | { |
| 433 | + struct pwm_device *pwm; |
| 434 | + |
| 448 | 435 | lirc_rx51_driver.features = LIRC_RX51_DRIVER_FEATURES; |
| 449 | 436 | lirc_rx51.pdata = dev->dev.platform_data; |
| 437 | + |
| 438 | + if (!lirc_rx51.pdata) { |
| 439 | + dev_err(&dev->dev, "Platform Data is missing\n"); |
| 440 | + return -ENXIO; |
| 441 | + } |
| 442 | + |
| 450 | 443 | if (!lirc_rx51.pdata->dmtimer) { |
| 451 | 444 | dev_err(&dev->dev, "no dmtimer?\n"); |
| 452 | 445 | return -ENODEV; |
| 453 | 446 | } |
| 454 | 447 | |
| 455 | | − lirc_rx51.pwm_timer_num = lirc_rx51.pdata->pwm_timer; |
| 448 | + pwm = pwm_get(&dev->dev, NULL); |
| 449 | + if (IS_ERR(pwm)) { |
| 450 | + int err = PTR_ERR(pwm); |
| 451 | + |
| 452 | + if (err != -EPROBE_DEFER) |
| 453 | + dev_err(&dev->dev, "pwm_get failed: %d\n", err); |
| 454 | + return err; |
| 455 | + } |
| 456 | + |
| 457 | + /* Use default, in case userspace does not set the carrier */ |
| 458 | + lirc_rx51.freq = DIV_ROUND_CLOSEST(pwm_get_period(pwm), NSEC_PER_SEC); |
| 459 | + pwm_put(pwm); |
| 460 | + |
| 456 | 461 | lirc_rx51.dmtimer = lirc_rx51.pdata->dmtimer; |
| 457 | 462 | lirc_rx51.dev = &dev->dev; |
| 458 | 463 | lirc_rx51_driver.dev = &dev->dev; |
| @@ -464,8 +469,6 @@ static int lirc_rx51_probe(struct platform_device *dev) · 5 unmodified lines |
| 464 | 469 | lirc_rx51_driver.minor); |
| 465 | 470 | return lirc_rx51_driver.minor; |
| 466 | 471 | } |
| 467 | | − dev_info(lirc_rx51.dev, "registration ok, minor: %d, pwm: %d\n", |
| 468 | | − lirc_rx51_driver.minor, lirc_rx51.pwm_timer_num); |
| 469 | 472 | |
| 470 | 473 | return 0; |
| 471 | 474 | } |