This source file includes following definitions.
- envtrl_i2c_test_pin
- envctrl_i2c_test_bb
- envctrl_i2c_read_addr
- envctrl_i2c_write_addr
- envctrl_i2c_read_data
- envctrl_i2c_write_data
- envctrl_i2c_stop
- envctrl_i2c_read_8591
- envctrl_i2c_read_8574
- envctrl_i2c_data_translate
- envctrl_read_cpu_info
- envctrl_read_noncpu_info
- envctrl_i2c_fan_status
- envctrl_i2c_globaladdr
- envctrl_i2c_voltage_status
- envctrl_read
- envctrl_ioctl
- envctrl_open
- envctrl_release
- envctrl_set_mon
- envctrl_init_adc
- envctrl_init_fanstat
- envctrl_init_globaladdr
- envctrl_init_voltage_status
- envctrl_init_i2c_child
- envctrl_get_i2c_child
- envctrl_do_shutdown
- kenvctrld
- envctrl_probe
- envctrl_remove
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22 #include <linux/module.h>
23 #include <linux/kthread.h>
24 #include <linux/delay.h>
25 #include <linux/ioport.h>
26 #include <linux/miscdevice.h>
27 #include <linux/kmod.h>
28 #include <linux/reboot.h>
29 #include <linux/slab.h>
30 #include <linux/of.h>
31 #include <linux/of_device.h>
32
33 #include <linux/uaccess.h>
34 #include <asm/envctrl.h>
35 #include <asm/io.h>
36
37 #define DRIVER_NAME "envctrl"
38 #define PFX DRIVER_NAME ": "
39
40 #define ENVCTRL_MINOR 162
41
42 #define PCF8584_ADDRESS 0x55
43
44 #define CONTROL_PIN 0x80
45 #define CONTROL_ES0 0x40
46 #define CONTROL_ES1 0x20
47 #define CONTROL_ES2 0x10
48 #define CONTROL_ENI 0x08
49 #define CONTROL_STA 0x04
50 #define CONTROL_STO 0x02
51 #define CONTROL_ACK 0x01
52
53 #define STATUS_PIN 0x80
54 #define STATUS_STS 0x20
55 #define STATUS_BER 0x10
56 #define STATUS_LRB 0x08
57 #define STATUS_AD0 0x08
58 #define STATUS_AAB 0x04
59 #define STATUS_LAB 0x02
60 #define STATUS_BB 0x01
61
62
63
64
65 #define BUS_CLK_90 0x00
66 #define BUS_CLK_45 0x01
67 #define BUS_CLK_11 0x02
68 #define BUS_CLK_1_5 0x03
69
70 #define CLK_3 0x00
71 #define CLK_4_43 0x10
72 #define CLK_6 0x14
73 #define CLK_8 0x18
74 #define CLK_12 0x1c
75
76 #define OBD_SEND_START 0xc5
77 #define OBD_SEND_STOP 0xc3
78
79
80
81
82 #define PCF8584_MAX_CHANNELS 8
83 #define PCF8584_GLOBALADDR_TYPE 6
84 #define PCF8584_FANSTAT_TYPE 3
85 #define PCF8584_VOLTAGE_TYPE 2
86 #define PCF8584_TEMP_TYPE 1
87
88
89
90
91 #define ENVCTRL_NOMON 0
92 #define ENVCTRL_CPUTEMP_MON 1
93 #define ENVCTRL_CPUVOLTAGE_MON 2
94 #define ENVCTRL_FANSTAT_MON 3
95 #define ENVCTRL_ETHERTEMP_MON 4
96
97 #define ENVCTRL_VOLTAGESTAT_MON 5
98 #define ENVCTRL_MTHRBDTEMP_MON 6
99 #define ENVCTRL_SCSITEMP_MON 7
100 #define ENVCTRL_GLOBALADDR_MON 8
101
102
103
104
105 #define I2C_ADC 0
106 #define I2C_GPIO 1
107
108
109
110
111
112 #define ENVCTRL_TRANSLATE_NO 0
113 #define ENVCTRL_TRANSLATE_PARTIAL 1
114 #define ENVCTRL_TRANSLATE_COMBINED 2
115 #define ENVCTRL_TRANSLATE_FULL 3
116 #define ENVCTRL_TRANSLATE_SCALE 4
117
118
119 #define ENVCTRL_MAX_CPU 4
120 #define CHANNEL_DESC_SZ 256
121
122
123 #define ENVCTRL_GLOBALADDR_ADDR_MASK 0x1F
124 #define ENVCTRL_GLOBALADDR_PSTAT_MASK 0x60
125
126
127
128
129 #define ENVCTRL_CPCI_IGNORED_NODE 0x70
130
131 #define PCF8584_DATA 0x00
132 #define PCF8584_CSR 0x01
133
134
135
136
137 struct pcf8584_channel {
138 unsigned char chnl_no;
139 unsigned char io_direction;
140 unsigned char type;
141 unsigned char last;
142 };
143
144
145
146
147 struct pcf8584_tblprop {
148 unsigned int type;
149 unsigned int scale;
150 unsigned int offset;
151 unsigned int size;
152 };
153
154
155 struct i2c_child_t {
156
157 unsigned char i2ctype;
158 unsigned long addr;
159 struct pcf8584_channel chnl_array[PCF8584_MAX_CHANNELS];
160
161
162 unsigned int total_chnls;
163 unsigned char fan_mask;
164 unsigned char voltage_mask;
165 struct pcf8584_tblprop tblprop_array[PCF8584_MAX_CHANNELS];
166
167
168 unsigned int total_tbls;
169 char *tables;
170 char chnls_desc[CHANNEL_DESC_SZ];
171 char mon_type[PCF8584_MAX_CHANNELS];
172 };
173
174 static void __iomem *i2c;
175 static struct i2c_child_t i2c_childlist[ENVCTRL_MAX_CPU*2];
176 static unsigned char chnls_mask[] = { 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80 };
177 static unsigned int warning_temperature = 0;
178 static unsigned int shutdown_temperature = 0;
179 static char read_cpu;
180
181
182 static struct i2c_child_t *envctrl_get_i2c_child(unsigned char);
183
184
185
186
187
188 static void envtrl_i2c_test_pin(void)
189 {
190 int limit = 1000000;
191
192 while (--limit > 0) {
193 if (!(readb(i2c + PCF8584_CSR) & STATUS_PIN))
194 break;
195 udelay(1);
196 }
197
198 if (limit <= 0)
199 printk(KERN_INFO PFX "Pin status will not clear.\n");
200 }
201
202
203
204
205 static void envctrl_i2c_test_bb(void)
206 {
207 int limit = 1000000;
208
209 while (--limit > 0) {
210
211 if (readb(i2c + PCF8584_CSR) & STATUS_BB)
212 break;
213 udelay(1);
214 }
215
216 if (limit <= 0)
217 printk(KERN_INFO PFX "Busy bit will not clear.\n");
218 }
219
220
221
222
223 static int envctrl_i2c_read_addr(unsigned char addr)
224 {
225 envctrl_i2c_test_bb();
226
227
228 writeb(addr + 1, i2c + PCF8584_DATA);
229
230 envctrl_i2c_test_bb();
231
232 writeb(OBD_SEND_START, i2c + PCF8584_CSR);
233
234
235 envtrl_i2c_test_pin();
236
237
238 if (!(readb(i2c + PCF8584_CSR) & STATUS_LRB)) {
239 return readb(i2c + PCF8584_DATA);
240 } else {
241 writeb(OBD_SEND_STOP, i2c + PCF8584_CSR);
242 return 0;
243 }
244 }
245
246
247
248
249 static void envctrl_i2c_write_addr(unsigned char addr)
250 {
251 envctrl_i2c_test_bb();
252 writeb(addr, i2c + PCF8584_DATA);
253
254
255 writeb(OBD_SEND_START, i2c + PCF8584_CSR);
256 }
257
258
259
260
261
262 static unsigned char envctrl_i2c_read_data(void)
263 {
264 envtrl_i2c_test_pin();
265 writeb(CONTROL_ES0, i2c + PCF8584_CSR);
266 return readb(i2c + PCF8584_DATA);
267 }
268
269
270
271
272 static void envctrl_i2c_write_data(unsigned char port)
273 {
274 envtrl_i2c_test_pin();
275 writeb(port, i2c + PCF8584_DATA);
276 }
277
278
279
280
281 static void envctrl_i2c_stop(void)
282 {
283 envtrl_i2c_test_pin();
284 writeb(OBD_SEND_STOP, i2c + PCF8584_CSR);
285 }
286
287
288
289
290 static unsigned char envctrl_i2c_read_8591(unsigned char addr, unsigned char port)
291 {
292
293 envctrl_i2c_write_addr(addr);
294
295
296 envctrl_i2c_write_data(port);
297 envctrl_i2c_stop();
298
299
300 envctrl_i2c_read_addr(addr);
301
302
303 envctrl_i2c_read_data();
304 envctrl_i2c_stop();
305
306 return readb(i2c + PCF8584_DATA);
307 }
308
309
310
311
312 static unsigned char envctrl_i2c_read_8574(unsigned char addr)
313 {
314 unsigned char rd;
315
316 envctrl_i2c_read_addr(addr);
317
318
319 rd = envctrl_i2c_read_data();
320 envctrl_i2c_stop();
321 return rd;
322 }
323
324
325
326
327
328 static int envctrl_i2c_data_translate(unsigned char data, int translate_type,
329 int scale, char *tbl, char *bufdata)
330 {
331 int len = 0;
332
333 switch (translate_type) {
334 case ENVCTRL_TRANSLATE_NO:
335
336 len = 1;
337 bufdata[0] = data;
338 break;
339
340 case ENVCTRL_TRANSLATE_FULL:
341
342 len = 1;
343 bufdata[0] = tbl[data];
344 break;
345
346 case ENVCTRL_TRANSLATE_SCALE:
347
348 sprintf(bufdata,"%d ", (tbl[data] * 10) / (scale));
349 len = strlen(bufdata);
350 bufdata[len - 1] = bufdata[len - 2];
351 bufdata[len - 2] = '.';
352 break;
353
354 default:
355 break;
356 }
357
358 return len;
359 }
360
361
362
363
364 static int envctrl_read_cpu_info(int cpu, struct i2c_child_t *pchild,
365 char mon_type, unsigned char *bufdata)
366 {
367 unsigned char data;
368 int i;
369 char *tbl, j = -1;
370
371
372 for (i = 0; i < PCF8584_MAX_CHANNELS; i++) {
373 if (pchild->mon_type[i] == mon_type) {
374 if (++j == cpu) {
375 break;
376 }
377 }
378 }
379
380 if (j != cpu)
381 return 0;
382
383
384 data = envctrl_i2c_read_8591((unsigned char)pchild->addr,
385 (unsigned char)pchild->chnl_array[i].chnl_no);
386
387
388 tbl = pchild->tables + pchild->tblprop_array[i].offset;
389
390 return envctrl_i2c_data_translate(data, pchild->tblprop_array[i].type,
391 pchild->tblprop_array[i].scale,
392 tbl, bufdata);
393 }
394
395
396
397
398
399 static int envctrl_read_noncpu_info(struct i2c_child_t *pchild,
400 char mon_type, unsigned char *bufdata)
401 {
402 unsigned char data;
403 int i;
404 char *tbl = NULL;
405
406 for (i = 0; i < PCF8584_MAX_CHANNELS; i++) {
407 if (pchild->mon_type[i] == mon_type)
408 break;
409 }
410
411 if (i >= PCF8584_MAX_CHANNELS)
412 return 0;
413
414
415 data = envctrl_i2c_read_8591((unsigned char)pchild->addr,
416 (unsigned char)pchild->chnl_array[i].chnl_no);
417
418
419 tbl = pchild->tables + pchild->tblprop_array[i].offset;
420
421 return envctrl_i2c_data_translate(data, pchild->tblprop_array[i].type,
422 pchild->tblprop_array[i].scale,
423 tbl, bufdata);
424 }
425
426
427
428
429 static int envctrl_i2c_fan_status(struct i2c_child_t *pchild,
430 unsigned char data,
431 char *bufdata)
432 {
433 unsigned char tmp, ret = 0;
434 int i, j = 0;
435
436 tmp = data & pchild->fan_mask;
437
438 if (tmp == pchild->fan_mask) {
439
440 ret = ENVCTRL_ALL_FANS_GOOD;
441 } else if (tmp == 0) {
442
443 ret = ENVCTRL_ALL_FANS_BAD;
444 } else {
445
446
447
448
449
450
451 for (i = 0; i < PCF8584_MAX_CHANNELS;i++) {
452 if (pchild->fan_mask & chnls_mask[i]) {
453 if (!(chnls_mask[i] & tmp))
454 ret |= chnls_mask[j];
455
456 j++;
457 }
458 }
459 }
460
461 bufdata[0] = ret;
462 return 1;
463 }
464
465
466
467
468 static int envctrl_i2c_globaladdr(struct i2c_child_t *pchild,
469 unsigned char data,
470 char *bufdata)
471 {
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486 bufdata[0] = (data & ENVCTRL_GLOBALADDR_ADDR_MASK);
487 return 1;
488 }
489
490
491
492
493 static unsigned char envctrl_i2c_voltage_status(struct i2c_child_t *pchild,
494 unsigned char data,
495 char *bufdata)
496 {
497 unsigned char tmp, ret = 0;
498 int i, j = 0;
499
500 tmp = data & pchild->voltage_mask;
501
502
503 if (tmp == pchild->voltage_mask) {
504
505 ret = ENVCTRL_VOLTAGE_POWERSUPPLY_GOOD;
506 } else if (tmp == 0) {
507
508 ret = ENVCTRL_VOLTAGE_POWERSUPPLY_BAD;
509 } else {
510
511 for (i = 0; i < PCF8584_MAX_CHANNELS; i++) {
512 if (pchild->voltage_mask & chnls_mask[i]) {
513 j++;
514
515
516 if (!(chnls_mask[i] & tmp))
517 break;
518 }
519 }
520
521
522
523
524
525 if (j == 1)
526 ret = ENVCTRL_VOLTAGE_BAD;
527 else
528 ret = ENVCTRL_POWERSUPPLY_BAD;
529 }
530
531 bufdata[0] = ret;
532 return 1;
533 }
534
535
536
537
538 static ssize_t
539 envctrl_read(struct file *file, char __user *buf, size_t count, loff_t *ppos)
540 {
541 struct i2c_child_t *pchild;
542 unsigned char data[10];
543 int ret = 0;
544
545
546
547
548
549
550 switch ((int)(long)file->private_data) {
551 case ENVCTRL_RD_WARNING_TEMPERATURE:
552 if (warning_temperature == 0)
553 return 0;
554
555 data[0] = (unsigned char)(warning_temperature);
556 ret = 1;
557 if (copy_to_user(buf, data, ret))
558 ret = -EFAULT;
559 break;
560
561 case ENVCTRL_RD_SHUTDOWN_TEMPERATURE:
562 if (shutdown_temperature == 0)
563 return 0;
564
565 data[0] = (unsigned char)(shutdown_temperature);
566 ret = 1;
567 if (copy_to_user(buf, data, ret))
568 ret = -EFAULT;
569 break;
570
571 case ENVCTRL_RD_MTHRBD_TEMPERATURE:
572 if (!(pchild = envctrl_get_i2c_child(ENVCTRL_MTHRBDTEMP_MON)))
573 return 0;
574 ret = envctrl_read_noncpu_info(pchild, ENVCTRL_MTHRBDTEMP_MON, data);
575 if (copy_to_user(buf, data, ret))
576 ret = -EFAULT;
577 break;
578
579 case ENVCTRL_RD_CPU_TEMPERATURE:
580 if (!(pchild = envctrl_get_i2c_child(ENVCTRL_CPUTEMP_MON)))
581 return 0;
582 ret = envctrl_read_cpu_info(read_cpu, pchild, ENVCTRL_CPUTEMP_MON, data);
583
584
585 if (copy_to_user(buf, data, ret))
586 ret = -EFAULT;
587 break;
588
589 case ENVCTRL_RD_CPU_VOLTAGE:
590 if (!(pchild = envctrl_get_i2c_child(ENVCTRL_CPUVOLTAGE_MON)))
591 return 0;
592 ret = envctrl_read_cpu_info(read_cpu, pchild, ENVCTRL_CPUVOLTAGE_MON, data);
593
594
595 if (copy_to_user(buf, data, ret))
596 ret = -EFAULT;
597 break;
598
599 case ENVCTRL_RD_SCSI_TEMPERATURE:
600 if (!(pchild = envctrl_get_i2c_child(ENVCTRL_SCSITEMP_MON)))
601 return 0;
602 ret = envctrl_read_noncpu_info(pchild, ENVCTRL_SCSITEMP_MON, data);
603 if (copy_to_user(buf, data, ret))
604 ret = -EFAULT;
605 break;
606
607 case ENVCTRL_RD_ETHERNET_TEMPERATURE:
608 if (!(pchild = envctrl_get_i2c_child(ENVCTRL_ETHERTEMP_MON)))
609 return 0;
610 ret = envctrl_read_noncpu_info(pchild, ENVCTRL_ETHERTEMP_MON, data);
611 if (copy_to_user(buf, data, ret))
612 ret = -EFAULT;
613 break;
614
615 case ENVCTRL_RD_FAN_STATUS:
616 if (!(pchild = envctrl_get_i2c_child(ENVCTRL_FANSTAT_MON)))
617 return 0;
618 data[0] = envctrl_i2c_read_8574(pchild->addr);
619 ret = envctrl_i2c_fan_status(pchild,data[0], data);
620 if (copy_to_user(buf, data, ret))
621 ret = -EFAULT;
622 break;
623
624 case ENVCTRL_RD_GLOBALADDRESS:
625 if (!(pchild = envctrl_get_i2c_child(ENVCTRL_GLOBALADDR_MON)))
626 return 0;
627 data[0] = envctrl_i2c_read_8574(pchild->addr);
628 ret = envctrl_i2c_globaladdr(pchild, data[0], data);
629 if (copy_to_user(buf, data, ret))
630 ret = -EFAULT;
631 break;
632
633 case ENVCTRL_RD_VOLTAGE_STATUS:
634 if (!(pchild = envctrl_get_i2c_child(ENVCTRL_VOLTAGESTAT_MON)))
635
636 if (!(pchild = envctrl_get_i2c_child(ENVCTRL_GLOBALADDR_MON)))
637 return 0;
638 data[0] = envctrl_i2c_read_8574(pchild->addr);
639 ret = envctrl_i2c_voltage_status(pchild, data[0], data);
640 if (copy_to_user(buf, data, ret))
641 ret = -EFAULT;
642 break;
643
644 default:
645 break;
646
647 }
648
649 return ret;
650 }
651
652
653
654
655 static long
656 envctrl_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
657 {
658 char __user *infobuf;
659
660 switch (cmd) {
661 case ENVCTRL_RD_WARNING_TEMPERATURE:
662 case ENVCTRL_RD_SHUTDOWN_TEMPERATURE:
663 case ENVCTRL_RD_MTHRBD_TEMPERATURE:
664 case ENVCTRL_RD_FAN_STATUS:
665 case ENVCTRL_RD_VOLTAGE_STATUS:
666 case ENVCTRL_RD_ETHERNET_TEMPERATURE:
667 case ENVCTRL_RD_SCSI_TEMPERATURE:
668 case ENVCTRL_RD_GLOBALADDRESS:
669 file->private_data = (void *)(long)cmd;
670 break;
671
672 case ENVCTRL_RD_CPU_TEMPERATURE:
673 case ENVCTRL_RD_CPU_VOLTAGE:
674
675
676
677 infobuf = (char __user *) arg;
678 if (infobuf == NULL) {
679 read_cpu = 0;
680 }else {
681 get_user(read_cpu, infobuf);
682 }
683
684
685 file->private_data = (void *)(long)cmd;
686 break;
687
688 default:
689 return -EINVAL;
690 }
691
692 return 0;
693 }
694
695
696
697
698 static int
699 envctrl_open(struct inode *inode, struct file *file)
700 {
701 file->private_data = NULL;
702 return 0;
703 }
704
705
706
707
708 static int
709 envctrl_release(struct inode *inode, struct file *file)
710 {
711 return 0;
712 }
713
714 static const struct file_operations envctrl_fops = {
715 .owner = THIS_MODULE,
716 .read = envctrl_read,
717 .unlocked_ioctl = envctrl_ioctl,
718 #ifdef CONFIG_COMPAT
719 .compat_ioctl = envctrl_ioctl,
720 #endif
721 .open = envctrl_open,
722 .release = envctrl_release,
723 .llseek = noop_llseek,
724 };
725
726 static struct miscdevice envctrl_dev = {
727 ENVCTRL_MINOR,
728 "envctrl",
729 &envctrl_fops
730 };
731
732
733
734
735 static void envctrl_set_mon(struct i2c_child_t *pchild,
736 const char *chnl_desc,
737 int chnl_no)
738 {
739
740
741
742
743 if (!(strcmp(chnl_desc,"temp,cpu")) ||
744 !(strcmp(chnl_desc,"temp,cpu0")) ||
745 !(strcmp(chnl_desc,"temp,cpu1")) ||
746 !(strcmp(chnl_desc,"temp,cpu2")) ||
747 !(strcmp(chnl_desc,"temp,cpu3")))
748 pchild->mon_type[chnl_no] = ENVCTRL_CPUTEMP_MON;
749
750 if (!(strcmp(chnl_desc,"vddcore,cpu0")) ||
751 !(strcmp(chnl_desc,"vddcore,cpu1")) ||
752 !(strcmp(chnl_desc,"vddcore,cpu2")) ||
753 !(strcmp(chnl_desc,"vddcore,cpu3")))
754 pchild->mon_type[chnl_no] = ENVCTRL_CPUVOLTAGE_MON;
755
756 if (!(strcmp(chnl_desc,"temp,motherboard")))
757 pchild->mon_type[chnl_no] = ENVCTRL_MTHRBDTEMP_MON;
758
759 if (!(strcmp(chnl_desc,"temp,scsi")))
760 pchild->mon_type[chnl_no] = ENVCTRL_SCSITEMP_MON;
761
762 if (!(strcmp(chnl_desc,"temp,ethernet")))
763 pchild->mon_type[chnl_no] = ENVCTRL_ETHERTEMP_MON;
764 }
765
766
767
768
769
770 static void envctrl_init_adc(struct i2c_child_t *pchild, struct device_node *dp)
771 {
772 int i = 0, len;
773 const char *pos;
774 const unsigned int *pval;
775
776
777 pos = of_get_property(dp, "channels-description", &len);
778
779 while (len > 0) {
780 int l = strlen(pos) + 1;
781 envctrl_set_mon(pchild, pos, i++);
782 len -= l;
783 pos += l;
784 }
785
786
787 pval = of_get_property(dp, "warning-temp", NULL);
788 if (pval)
789 warning_temperature = *pval;
790
791 pval = of_get_property(dp, "shutdown-temp", NULL);
792 if (pval)
793 shutdown_temperature = *pval;
794 }
795
796
797
798
799 static void envctrl_init_fanstat(struct i2c_child_t *pchild)
800 {
801 int i;
802
803
804 for (i = 0; i < pchild->total_chnls; i++)
805 pchild->fan_mask |= chnls_mask[(pchild->chnl_array[i]).chnl_no];
806
807
808
809
810 pchild->mon_type[0] = ENVCTRL_FANSTAT_MON;
811 }
812
813
814
815
816 static void envctrl_init_globaladdr(struct i2c_child_t *pchild)
817 {
818 int i;
819
820
821
822
823
824
825
826
827
828
829
830
831
832
833 for (i = 0; i < pchild->total_chnls; i++) {
834 if (PCF8584_VOLTAGE_TYPE == pchild->chnl_array[i].type) {
835 pchild->voltage_mask |= chnls_mask[i];
836 }
837 }
838
839
840
841
842
843 pchild->mon_type[0] = ENVCTRL_GLOBALADDR_MON;
844 }
845
846
847 static void envctrl_init_voltage_status(struct i2c_child_t *pchild)
848 {
849 int i;
850
851
852 for (i = 0; i < pchild->total_chnls; i++)
853 pchild->voltage_mask |= chnls_mask[(pchild->chnl_array[i]).chnl_no];
854
855
856
857
858 pchild->mon_type[0] = ENVCTRL_VOLTAGESTAT_MON;
859 }
860
861
862
863
864 static void envctrl_init_i2c_child(struct device_node *dp,
865 struct i2c_child_t *pchild)
866 {
867 int len, i, tbls_size = 0;
868 const void *pval;
869
870
871 pval = of_get_property(dp, "reg", &len);
872 memcpy(&pchild->addr, pval, len);
873
874
875 pval = of_get_property(dp, "translation", &len);
876 if (pval && len > 0) {
877 memcpy(pchild->tblprop_array, pval, len);
878 pchild->total_tbls = len / sizeof(struct pcf8584_tblprop);
879 for (i = 0; i < pchild->total_tbls; i++) {
880 if ((pchild->tblprop_array[i].size + pchild->tblprop_array[i].offset) > tbls_size) {
881 tbls_size = pchild->tblprop_array[i].size + pchild->tblprop_array[i].offset;
882 }
883 }
884
885 pchild->tables = kmalloc(tbls_size, GFP_KERNEL);
886 if (pchild->tables == NULL){
887 printk(KERN_ERR PFX "Failed to allocate table.\n");
888 return;
889 }
890 pval = of_get_property(dp, "tables", &len);
891 if (!pval || len <= 0) {
892 printk(KERN_ERR PFX "Failed to get table.\n");
893 return;
894 }
895 memcpy(pchild->tables, pval, len);
896 }
897
898
899
900
901
902
903
904
905 if (ENVCTRL_CPCI_IGNORED_NODE == pchild->addr) {
906 struct device_node *root_node;
907 int len;
908
909 root_node = of_find_node_by_path("/");
910 if (of_node_name_eq(root_node, "SUNW,UltraSPARC-IIi-cEngine")) {
911 for (len = 0; len < PCF8584_MAX_CHANNELS; ++len) {
912 pchild->mon_type[len] = ENVCTRL_NOMON;
913 }
914 of_node_put(root_node);
915 return;
916 }
917 of_node_put(root_node);
918 }
919
920
921 pval = of_get_property(dp, "channels-in-use", &len);
922 memcpy(pchild->chnl_array, pval, len);
923 pchild->total_chnls = len / sizeof(struct pcf8584_channel);
924
925 for (i = 0; i < pchild->total_chnls; i++) {
926 switch (pchild->chnl_array[i].type) {
927 case PCF8584_TEMP_TYPE:
928 envctrl_init_adc(pchild, dp);
929 break;
930
931 case PCF8584_GLOBALADDR_TYPE:
932 envctrl_init_globaladdr(pchild);
933 i = pchild->total_chnls;
934 break;
935
936 case PCF8584_FANSTAT_TYPE:
937 envctrl_init_fanstat(pchild);
938 i = pchild->total_chnls;
939 break;
940
941 case PCF8584_VOLTAGE_TYPE:
942 if (pchild->i2ctype == I2C_ADC) {
943 envctrl_init_adc(pchild,dp);
944 } else {
945 envctrl_init_voltage_status(pchild);
946 }
947 i = pchild->total_chnls;
948 break;
949
950 default:
951 break;
952 }
953 }
954 }
955
956
957
958
959 static struct i2c_child_t *envctrl_get_i2c_child(unsigned char mon_type)
960 {
961 int i, j;
962
963 for (i = 0; i < ENVCTRL_MAX_CPU*2; i++) {
964 for (j = 0; j < PCF8584_MAX_CHANNELS; j++) {
965 if (i2c_childlist[i].mon_type[j] == mon_type) {
966 return (struct i2c_child_t *)(&(i2c_childlist[i]));
967 }
968 }
969 }
970 return NULL;
971 }
972
973 static void envctrl_do_shutdown(void)
974 {
975 static int inprog = 0;
976
977 if (inprog != 0)
978 return;
979
980 inprog = 1;
981 printk(KERN_CRIT "kenvctrld: WARNING: Shutting down the system now.\n");
982 orderly_poweroff(true);
983 }
984
985 static struct task_struct *kenvctrld_task;
986
987 static int kenvctrld(void *__unused)
988 {
989 int poll_interval;
990 int whichcpu;
991 char tempbuf[10];
992 struct i2c_child_t *cputemp;
993
994 if (NULL == (cputemp = envctrl_get_i2c_child(ENVCTRL_CPUTEMP_MON))) {
995 printk(KERN_ERR PFX
996 "kenvctrld unable to monitor CPU temp-- exiting\n");
997 return -ENODEV;
998 }
999
1000 poll_interval = 5000;
1001
1002 printk(KERN_INFO PFX "%s starting...\n", current->comm);
1003 for (;;) {
1004 msleep_interruptible(poll_interval);
1005
1006 if (kthread_should_stop())
1007 break;
1008
1009 for (whichcpu = 0; whichcpu < ENVCTRL_MAX_CPU; ++whichcpu) {
1010 if (0 < envctrl_read_cpu_info(whichcpu, cputemp,
1011 ENVCTRL_CPUTEMP_MON,
1012 tempbuf)) {
1013 if (tempbuf[0] >= shutdown_temperature) {
1014 printk(KERN_CRIT
1015 "%s: WARNING: CPU%i temperature %i C meets or exceeds "\
1016 "shutdown threshold %i C\n",
1017 current->comm, whichcpu,
1018 tempbuf[0], shutdown_temperature);
1019 envctrl_do_shutdown();
1020 }
1021 }
1022 }
1023 }
1024 printk(KERN_INFO PFX "%s exiting...\n", current->comm);
1025 return 0;
1026 }
1027
1028 static int envctrl_probe(struct platform_device *op)
1029 {
1030 struct device_node *dp;
1031 int index, err;
1032
1033 if (i2c)
1034 return -EINVAL;
1035
1036 i2c = of_ioremap(&op->resource[0], 0, 0x2, DRIVER_NAME);
1037 if (!i2c)
1038 return -ENOMEM;
1039
1040 index = 0;
1041 dp = op->dev.of_node->child;
1042 while (dp) {
1043 if (of_node_name_eq(dp, "gpio")) {
1044 i2c_childlist[index].i2ctype = I2C_GPIO;
1045 envctrl_init_i2c_child(dp, &(i2c_childlist[index++]));
1046 } else if (of_node_name_eq(dp, "adc")) {
1047 i2c_childlist[index].i2ctype = I2C_ADC;
1048 envctrl_init_i2c_child(dp, &(i2c_childlist[index++]));
1049 }
1050
1051 dp = dp->sibling;
1052 }
1053
1054
1055 writeb(CONTROL_PIN, i2c + PCF8584_CSR);
1056 writeb(PCF8584_ADDRESS, i2c + PCF8584_DATA);
1057
1058
1059 writeb(CONTROL_PIN | CONTROL_ES1, i2c + PCF8584_CSR);
1060 writeb(CLK_4_43 | BUS_CLK_90, i2c + PCF8584_DATA);
1061
1062
1063 writeb(CONTROL_PIN | CONTROL_ES0 | CONTROL_ACK, i2c + PCF8584_CSR);
1064 udelay(200);
1065
1066
1067 err = misc_register(&envctrl_dev);
1068 if (err) {
1069 printk(KERN_ERR PFX "Unable to get misc minor %d\n",
1070 envctrl_dev.minor);
1071 goto out_iounmap;
1072 }
1073
1074
1075
1076
1077
1078 printk(KERN_INFO PFX "Initialized ");
1079 for (--index; index >= 0; --index) {
1080 printk("[%s 0x%lx]%s",
1081 (I2C_ADC == i2c_childlist[index].i2ctype) ? "adc" :
1082 ((I2C_GPIO == i2c_childlist[index].i2ctype) ? "gpio" : "unknown"),
1083 i2c_childlist[index].addr, (0 == index) ? "\n" : " ");
1084 }
1085
1086 kenvctrld_task = kthread_run(kenvctrld, NULL, "kenvctrld");
1087 if (IS_ERR(kenvctrld_task)) {
1088 err = PTR_ERR(kenvctrld_task);
1089 goto out_deregister;
1090 }
1091
1092 return 0;
1093
1094 out_deregister:
1095 misc_deregister(&envctrl_dev);
1096 out_iounmap:
1097 of_iounmap(&op->resource[0], i2c, 0x2);
1098 for (index = 0; index < ENVCTRL_MAX_CPU * 2; index++)
1099 kfree(i2c_childlist[index].tables);
1100
1101 return err;
1102 }
1103
1104 static int envctrl_remove(struct platform_device *op)
1105 {
1106 int index;
1107
1108 kthread_stop(kenvctrld_task);
1109
1110 of_iounmap(&op->resource[0], i2c, 0x2);
1111 misc_deregister(&envctrl_dev);
1112
1113 for (index = 0; index < ENVCTRL_MAX_CPU * 2; index++)
1114 kfree(i2c_childlist[index].tables);
1115
1116 return 0;
1117 }
1118
1119 static const struct of_device_id envctrl_match[] = {
1120 {
1121 .name = "i2c",
1122 .compatible = "i2cpcf,8584",
1123 },
1124 {},
1125 };
1126 MODULE_DEVICE_TABLE(of, envctrl_match);
1127
1128 static struct platform_driver envctrl_driver = {
1129 .driver = {
1130 .name = DRIVER_NAME,
1131 .of_match_table = envctrl_match,
1132 },
1133 .probe = envctrl_probe,
1134 .remove = envctrl_remove,
1135 };
1136
1137 module_platform_driver(envctrl_driver);
1138
1139 MODULE_LICENSE("GPL");