123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164 |
- #include <assert.h>
- #include <fcntl.h>
- #include <stdint.h>
- #include <stdio.h>
- #include <stdlib.h>
- #include <unistd.h>
- #include <sys/mman.h>
- #include <sys/types.h>
- #include <sys/stat.h>
- #include <pci/pci.h>
- static struct pci_access *pacc;
- static uint32_t *map;
- static int fd;
- #define REGISTER 0x61254
- static void
- init (void)
- {
- fd = -1;
-
- struct pci_dev *dev;
- pacc = pci_alloc ();
- pacc->writeable = 1;
- pci_init (pacc);
- pci_scan_bus (pacc);
- for (dev = pacc->devices; dev != NULL; dev = dev->next)
- {
- pci_fill_info (dev, PCI_FILL_IDENT | PCI_FILL_BASES);
- if (dev->vendor_id != 0x8086 || dev->device_id != 0x27a2)
- continue;
- break;
- }
- if (dev == NULL)
- {
- fprintf (stderr, "Device not found.\n");
- goto fail;
- }
-
- fd = open ("/dev/mem", O_RDWR);
- if (fd == -1)
- {
- fprintf (stderr, "Cannot open memory. Are you root?\n");
- goto fail;
- }
- map = mmap (NULL, 4096, PROT_READ | PROT_WRITE, MAP_SHARED, fd, dev->base_addr[0] + (REGISTER & (~4095)));
- if (map != MAP_FAILED)
- return;
- else
- perror ("mmap failed");
- fail:
- if (pacc != NULL)
- pci_cleanup (pacc);
- if (fd != -1)
- close (fd);
- exit (1);
- }
- static void
- set_pwm (uint16_t freq, uint16_t duty)
- {
- assert (duty <= freq);
- map[((REGISTER - 4) & 4095) >> 2] = 0x80000000;
- map[(REGISTER & 4095) >> 2] = ((freq | 1) << 16) | duty;
- }
- int
- main (void)
- {
- init ();
- int exponent = 8;
- int diff = 0;
- int divisor = 2;
- uint16_t freq = 0x61;
- uint16_t duties[] = {
- #if 1
-
- 0xf,
- 0x13,
- 0x19,
- 0x1f,
- 0x23,
- 0x29,
- 0x2f,
- 0x35,
- 0x39,
- 0x3f,
- 0x45,
- 0x4b,
- 0x4f,
- 0x55,
- 0x5b,
- 0x61
- #else
-
- 0x2,
- 0x4,
- 0x5,
- 0x7,
- 0x9,
- 0xb,
- 0xd,
- 0x11,
- 0x14,
- 0x17,
- 0x1c,
- 0x20,
- 0x27,
- 0x31,
- 0x41,
- 0x61,
- #endif
- };
- #if 1
- for (unsigned int di = 0; di < sizeof (duties) / sizeof (duties[0]); di++)
- {
- uint16_t duty = duties[di];
- #else
- for (uint16_t duty = 0; duty < 0x61; duty++)
- {
- #endif
- #if 0
- }
- #endif
- uint16_t pwm_freq = (freq + diff) << exponent;
- pwm_freq += (pwm_freq >> divisor);
-
- uint16_t pwm_duty = (duty + diff) << exponent;
- pwm_duty += (pwm_duty >> divisor);
-
- set_pwm (pwm_freq, pwm_duty);
- sleep (1);
- }
- if (pacc != NULL)
- pci_cleanup (pacc);
- if (map != NULL)
- munmap (map, 4096);
- if (fd != -1)
- close (fd);
- return 0;
- }
|