Blame view

kernel/linux-rt-4.4.41/drivers/misc/ibmasm/dot_command.c 3.97 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
  /*
   * IBM ASM Service Processor Device Driver
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License as published by
   * the Free Software Foundation; either version 2 of the License, or
   * (at your option) any later version.
   *
   * This program is distributed in the hope that it will be useful,
   * but WITHOUT ANY WARRANTY; without even the implied warranty of
   * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   * GNU General Public License for more details.
   *
   * You should have received a copy of the GNU General Public License
   * along with this program; if not, write to the Free Software
   * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
   *
   * Copyright (C) IBM Corporation, 2004
   *
   * Author: Max Asböck <amax@us.ibm.com>
   *
   */
  
  #include "ibmasm.h"
  #include "dot_command.h"
  
  /**
   * Dispatch an incoming message to the specific handler for the message.
   * Called from interrupt context.
   */
  void ibmasm_receive_message(struct service_processor *sp, void *message, int message_size)
  {
  	u32 size;
  	struct dot_command_header *header = (struct dot_command_header *)message;
  
  	if (message_size == 0)
  		return;
  
  	size = get_dot_command_size(message);
  	if (size == 0)
  		return;
  
  	if (size > message_size)
  		size = message_size;
  
  	switch (header->type) {
  	case sp_event:
  		ibmasm_receive_event(sp, message, size);
  		break;
  	case sp_command_response:
  		ibmasm_receive_command_response(sp, message, size);
  		break;
  	case sp_heartbeat:
  		ibmasm_receive_heartbeat(sp, message, size);
  		break;
  	default:
  		dev_err(sp->dev, "Received unknown message from service processor
  ");
  	}
  }
  
  
  #define INIT_BUFFER_SIZE 32
  
  
  /**
   * send the 4.3.5.10 dot command (driver VPD) to the service processor
   */
  int ibmasm_send_driver_vpd(struct service_processor *sp)
  {
  	struct command *command;
  	struct dot_command_header *header;
  	u8 *vpd_command;
  	u8 *vpd_data;
  	int result = 0;
  
  	command = ibmasm_new_command(sp, INIT_BUFFER_SIZE);
  	if (command == NULL)
  		return -ENOMEM;
  
  	header = (struct dot_command_header *)command->buffer;
  	header->type                = sp_write;
  	header->command_size        = 4;
  	header->data_size           = 16;
  	header->status              = 0;
  	header->reserved            = 0;
  
  	vpd_command = command->buffer + sizeof(struct dot_command_header);
  	vpd_command[0] = 0x4;
  	vpd_command[1] = 0x3;
  	vpd_command[2] = 0x5;
  	vpd_command[3] = 0xa;
  
  	vpd_data = vpd_command + header->command_size;
  	vpd_data[0] = 0;
  	strcat(vpd_data, IBMASM_DRIVER_VPD);
  	vpd_data[10] = 0;
  	vpd_data[15] = 0;
  
  	ibmasm_exec_command(sp, command);
  	ibmasm_wait_for_response(command, IBMASM_CMD_TIMEOUT_NORMAL);
  
  	if (command->status != IBMASM_CMD_COMPLETE)
  		result = -ENODEV;
  
  	command_put(command);
  
  	return result;
  }
  
  struct os_state_command {
  	struct dot_command_header	header;
  	unsigned char			command[3];
  	unsigned char			data;
  };
  
  /**
   * send the 4.3.6 dot command (os state) to the service processor
   * During driver init this function is called with os state "up".
   * This causes the service processor to start sending heartbeats the
   * driver.
   * During driver exit the function is called with os state "down",
   * causing the service processor to stop the heartbeats.
   */
  int ibmasm_send_os_state(struct service_processor *sp, int os_state)
  {
  	struct command *cmd;
  	struct os_state_command *os_state_cmd;
  	int result = 0;
  
  	cmd = ibmasm_new_command(sp, sizeof(struct os_state_command));
  	if (cmd == NULL)
  		return -ENOMEM;
  
  	os_state_cmd = (struct os_state_command *)cmd->buffer;
  	os_state_cmd->header.type		= sp_write;
  	os_state_cmd->header.command_size	= 3;
  	os_state_cmd->header.data_size		= 1;
  	os_state_cmd->header.status		= 0;
  	os_state_cmd->command[0]		= 4;
  	os_state_cmd->command[1]		= 3;
  	os_state_cmd->command[2]		= 6;
  	os_state_cmd->data			= os_state;
  
  	ibmasm_exec_command(sp, cmd);
  	ibmasm_wait_for_response(cmd, IBMASM_CMD_TIMEOUT_NORMAL);
  
  	if (cmd->status != IBMASM_CMD_COMPLETE)
  		result = -ENODEV;
  
  	command_put(cmd);
  	return result;
  }